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ABSTRACT 


•phi#  paper  describes  simplified  mathematical  models  of 
the  Space  Transportation  System  (STS)  Reaction  Control  Sys¬ 
tem  (RCS)  and  Digital  Autopilot  (DAP)  used  in  the  USAFA 
Proximity  Operations  Simulator  for  the  VAX  11/780  and  the 
Evans  and  Sutherland  PS  300  computers.  Included  in  the 
modeling  are  propellant  expenditures  for  translational 
maneuvers,  rotational  maneuvers,  and  attitude  maintenance 
and  on-orbit  trajectory  deviations  induced  by  RCS  cross  cou¬ 
pling.  This  simulator  serves  as  a  learning  aid  for  cadets 
studying  orbital  dynamics  and  STS  mission  planning  and  as  a 
research  platform  for  the  Department  of  Astronautics. 
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1 .  INTRODUCTION 


The  Space  Transportation  System  (STS)  Proximity  Opera¬ 
tions  Simulator  is  a  nine  degrees-of-freedom  trajectory 
integrator  (six  degrees  of  freedom  for  the  STS  and  three 
degrees  of  freedom  for  the  target)  which  generates  digital 
and  graphical  data  to  describe  and  record  relative  motion  of 
the  STS  Orbiter  and  a  free-flying  payload.  This  motion  is 
obtained  by  applying  the  Clohessy -Wilt shire  equations  for 
terminal  rendezvous/docking  with  the  earth  modeled  as  a  uni¬ 
form  sphere  (Appendix  B)  and  aerodynamic  forces  ignored. 
STS  position  relative  to  target  is  computed  by  a  first-order 
Euler  integrator  which  uses  quaternions  to  define  the  rota¬ 
tional  state  (Appendix  C). 

The  payload  is  modeled  as  a  spinning  Communications 
satellite.  The  Orbiter  is  treated  as  a  rigid  body  whose 
mass  properties  (gross  weight,  moments  and  products  of  iner¬ 
tia,  and  center  of  gravity  location)  are  set  by  Program 
THRUSTERS  and  automatically  read  in  at  the  beginning  of  the 
simulation.  These  properties  remain  constant  for  the  entire 
simulation. 

The  initial  state  of  the  simulation  is  defined  by  the 
user.  The  program  requires  altitude  and  inclination  of  tar¬ 
get  orbit  to  determine  proper  viewing  perspective  and  orbi¬ 
tal  dynamics.  The  user  must  also  input  Orbiter  position 
relative  to  payload.  The  program  sets  relative  velocity  and 
rotation  rates  to  zero  and  defines  initial  Orbiter  attitude 
such  that  the  payload  hay  faces  the  tarqet  with  the  Orbiter 
nose  pointed  away  from  the  earth.  The  user  also  has  the 
option  of  multiplying  shuttle  responsiveness  to  facilitate 
proximity  operations  training.  Digital  Autopilot  (DAP) 
parameters  are  predefined  and  cannot  be  changed  by  the  user. 

After  program  initialization,  user  inputs  are  made 
through  the  hand  controllers  and  DAP  panel  located  in  the 
Shuttle  Aft  Flight  Deck  Mockup.  The  left  controller  is  the 
Translational  Hand  Controller  (THC )  and  is  used  for  posi¬ 
tioning.  The  right  hand  controller  is  the  Rotational  Hand 
Controller  ( RHC )  and  controls  Orbiter  attitude.  Cross¬ 
coupling  accelerations  are  fully  modeled  in  the  simulation. 
The  program  reads  inputs  from  the  mockup  and  updates  posi¬ 
tion  and  attitude  every  40  milliseconds  and  monitors  fuel 
expended  from  each  tank.  Every  ten  seconds  Orbiter  position 
is  written  to  data  file  STS.TRK  should  the  user  wish  to  view 
his  flightpath  at  the  completion  of  the  simulation  using 
Program  STSPATH. 
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RCS  ACCELERATION  MODELING 


(This  chapter  is  taken  largely  from  chapters  3  &  4  of 
Reference  1) 


Table  1  contains  the  data  used  by  program  THRUSTERS  to 
compute  forces  and  torques  produced  by  individual  RCS  jets 
(with  plume  impingement).  The  left  column  contains  array 
index  numbers  used  for  thruster  identification.  The  second 
column  contains  jet  identification  mnemonics  (not  used  in 
actual  program).  The  next  three  columns  contain  thrust  com¬ 
ponents  in  Orbiter  body  axes.  These  are  followed  by  three 
columns  containing  station  coordinates  of  thrust  application 
point.  These  coordinates  are  used  in  conjunction  with  the 
last  column  to  calculate  torque  about  the  Orbiter  CG. 

For  a  CG  location  defined  by  arbitrary  station  coordi¬ 
nates  (STAcg,  BLcg,  WLcg)  *  t1ie  torque  produced  by  a  partic¬ 
ular  jet  is  computed  from  the  equation 


Table 

1.  RCS  Thruster  Data  (with 

plume  impingement) 

[thruster 

Fx 

Fy 

Fz 

STA 

BL 

WL 

C 

NO 

.  ID 

(LB) 

(LB) 

(LB) 

(IN) 

(IN) 

(IN) 

(FT) 

1 

F2F 

-879.4 

-26.2 

119.9 

306.72 

14.65 

392  .96 

0.0000 

« 

F3F 

-879.5 

0.0 

122.7 

306.72 

0.00 

394.45 

0.0000 

3 

F1F 

-879.4 

26.2 

119.9 

306.72 

-14.65 

392 .96 

0.0000 

4 

F1L 

-26.3 

873.6 

18.2 

362.67 

-69.50 

373.73 

0.0000 

5 

F3L 

-21.0 

870.3 

0.5 

364.71 

-71.65 

359.25 

0.0000 

6 

,  F2R 

-26.3 

-873.6 

18.2 

362.67 

69.50 

373.73 

0.0000 

7 

F4R 

-21.0 

-870.3 

0.  5 

364.71 

71 .65 

359.25 

0.0000 

a 

F2U 

-32.3 

-11.7 

874.4 

350.93 

14.39 

413.46 

0.0000 

9 

1  F3U 

-31.9 

0.0 

873.5 

350.92 

0.00 

414.53 

0.0000 

10 

F1U 

-32.3 

11 .7 

874.4 

350.93 

-14.3® 

413  .46 

0.0000 

li 

F2D 

-28.0 

-616.4 

-639.5 

333.84 

61 .42 

356.95 

0.0000 

12 

FID 

-28.0 

616.4 

-639. 5 

333.84 

-61 .42 

356.95 

0.0000 

13 

F4D 

-24.8 

-612.6 

-639.4 

348.44 

66.23 

358.44 

0.0000 

14 

F3D 

-24.8 

612.6 

-639.4 

348.44 

-66.23 

358.44 

0.0000 

15 

R3A 

856.8 

0.0 

151.1 

1555.29 

137.00 

473.06 

0.0000 

16 

R1A 

856.8 

0.0 

151.1 

1555.29 

124.00 

473.06 

0.0000 

17 

L3A 

856.8 

0.0 

151.1 

1555.29 

-137.00 

473.06 

0.0000 

18 

L1A 

856.8 

0.0 

151.1 

1555.29 

-124.00 

473.06 

0.0000 

19 

L4L 

0.0 

870.5 

-8.4 

1516.06 

-149.83 

455.21 

-0.5887 

20 

l  L2L 

0.0 

870.5 

-8.4 

1529.07 

-149.83 

455.21 

-0.6061 

21 

!  L3L 

0.0 

870.5 

-8.4 

1542.07 

-149.83 

455.21 

-0.6235 

22 

j  L1L 

0.0 

870.5 

-8.4 

1555.07 

-149.83 

455.21 

-0.6410 

23 

i  R4R 

0.0 

-870.5 

-8.4 

1516.06 

149.83 

455.21 

0.5887 

24 

|  R2R 

0.0 

-870.5 

-8.4 

1529.07 

149.83 

455.21 

0.6061 

25 

!  R3R 

0.0 

-870.5 

-8.4 

1542.07 

149.83 

455.21 

0.6235 

26 

R1R 

0.0 

-870.5 

-8.4 

1555.07 

149.83 

455.21 

0.6410 

27 

!  L4U 

29.0 

72.0 

870.0 

1520.04 

-116.51 

481.65 

-0.4615 

28 

L2U 

29.0 

72.0 

870.0 

1532.96 

-116.54 

481.65 

-0.3725 

29 

LIU 

29.0 

72.0 

870.0 

1545.87 

-116.58 

481  .65 

-0.2836 

30 

R4U 

29.0 

-72.0 

870.0 

1520.04 

116.51 

481.65 

0.4615 

31 

R2U 

29.0 

-72.0 

870.0 

1532.96 

116.54 

481  .65 

0.3725 

32 

i  R1U 

29.0 

-72.0 

870.0 

1545.87 

116.58 

481  .65 

0.2836 

33 

.  L4D 

312.4 

346.8 

-545.7 

1498.11 

-101.47 

420.49 

1.7413 

34 

!L2D 

312.4 

346.8 

-545.7 

1513.68 

-100.61 

424.63 

1 .4807 

35 

!  L3D 

312.4 

346.8 

-545.7 

1529. 23 

-99.79 

428.76 

1 .2208 

36 

;  R4D 

312.4 

-346.8 

-545.7 

1498.11 

101 .47 

4  20.4  9 

-1.7413 

37 

!  R2D 

312.4 

-346.8 

-548.7 

1513.68 

100.61 

424.63 

-1 .4807 

38 

R3D 

312.4 

-346.8 

-545.7 

1529.23 

99.79 

428.76 

-  1.2208 

39 

F5R 

-0.8 

-17.0 

-17.6 

324.35 

59. 70 

350.12 

0.0000 

40 

F5L 

-0.8 

17.0 

-17.6 

324.35 

-59.70 

350.12 

0.0000 

41 

R5R 

0.0 

-24.0 

-0.6 

1565.00 

149.87 

459.00 

0.0000 

42 

L5L 

0.0 

24.0 

-0.6 

1565.00 

-149.87 

459.00 

0.0000 

43 

1  R5D 

0.0 

0.0 

-24.0 

1565.00 

118.00 

455.44 

0.0000 

44 

L5D 

0.0 

0.0 

-24.0 

1565.00 

-118.00 

455.44 

0.0000 

(Reproduced  from  Reference  I) 


Table  2.  Typical  Orbiter  Mass  Properties 


DESCRIPTION 

WEIGHT . 

Ixx . 

lyy . 

Izz . 

I  yz . 

Izx . 

Ixy . 

CG  STA . 

CG  BL . 

CG  WL . 


VALUE 

200017.0  LB 
R87302.0  SLUG-FT 
6386877.0  SLUG-FT 
6694367.0  SLUG-FT 
-971.0  SLUG-FT 
247376.0  SLUG-FT 
5622.0  SLUG-FT 
1095.3  IN 
0.3  IN 
377.4  IN 


N)  \)  fO  \)  \)  N) 


L« 
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program  THRUSTERS  computes  steady-state  accelerations 
and  propellant  consumption  rates  for  each  of  the  44  RCS 
thrusters  and  writes  this  information  to  data  file 
RESPONSES.  The  user  may  specify  a  set  of  Orbiter  mass  pro¬ 
perties  or  use  the  preprogrammed  properties  from  Table  2. 

Table  3  shows  the  RESPONSES  data  file  for  the  properties 
listed  in  Table  2.  Each  row  corresponds  to  a  particular  RCS 
thruster.  The  first  three  columns  contain  the  body  axis 
components  of  the  steady-state  linear  acceleration  vector, 
and  columns  4-6  contain  the  corresponding  components  of 
angular  acceleration.  Columns  7-9  contain  rates  of  propel¬ 
lant  flow  from  the  forward,  aft  left,  and  aft  right  tanks 
respectively. 

Linear  accelerations  for  each  thruster  are  calculated  by 
the  equation 


aj  =  (32.174/W)  Fyj 


where  W  is  the  Orbiter  gross  weight  and  F  . ,  F  . ,  and  F  . 

x  d  y j  z  d 

represent  the  thrust  components  (from  Table  1).  The 
corresponding  angular  accelerations  are  given  by 


3  =  Cl]-1  T. 


where 


and  where  represents  the  individual  torque  vectors  pro¬ 
duced  by  the  designated  thruster  as  calculated  from  Equa¬ 
tions  (1)  through  (3).  The  [I]  matrix  represents  the 
Orbiter's  moments  of  inertia. 

Propellant  flow  rates  (columns  7-9  of  Table  3)  are 
assumed  to  be  3.1071  lb/ sec  for  each  active  primary  jet  and 
0.0923  Ib/sec  for  each  active  vernier  jet.  These  rates  are 
based  on  the  nominal  vacuum  thrust  magnitudes  (R70  lb  and  24 
lb)  and  specific  impulses  (290  sec  and  2R0  sec)  that  are 
given  in  Reference  2.  Each  thruster  is  always  assumed  to  be 
fed  from  its  nominal  source  (tank)  with  no  provisions  for 
simulating  propellant  cross feed. 


7 


3.  RCS  THRUSTER  FIRING  SELECTION 


(This  chapter  is  taken  largely  from  chapter  4  of  Refer¬ 
ence  1 ) 


Each  iteration  the  program  must  determine  which  thrus¬ 
ters  are  to  be  fired  for  attitude  and/or  translational  con¬ 
trol.  Rotation  Hand  Controller  (RHC),  Translation  Hand  Con¬ 
troller  ( THC ) ,  and  Digital  Auto  Pilot  (DAP)  inputs  are  read 
from  the  shuttle  mockup  every  40  milliseconds  and  applied  to 
one  of  four  available  firing  options  as  commanded  by  the 
DAP.  The  available  options  are  designated  V  (vernier  jets), 
P  (primary  jets),  PZI  (primary  jets  with  +Z  thrusters  inhi¬ 
bited),  and  HIGH  Z  (primary  jets  with  additional  +Z  thrus¬ 
ters).  Corresponding  to  each  of  these  options  is  a  jet- 
select  table  (Tables  4-7)  which  identifies  the  particular 
jet  or  combination  of  jets  that  is  to  be  fired  in  response 
to  each  of  the  six  possible  translation  acceleration  com¬ 
mands  (+X,  -X,  +Y,  -Y,  +Z,  -Z )  and  the  six  possible  rota¬ 
tional  commands  (+ROL,  -ROL,  +PCH ,  -PCH,  +YAW,  -YAW).  These 
jet-select  tables  are  read  from  the  RESPONSES  data  file  and 
stored  in  array  JET.  Jets  are  identified  by  the  mnemonics 
listed  in  the  second  column  of  Table  1. 

As  indicated  in  Table  4  by  the  absence  of  any  jet  desig¬ 
nations  for  the  execution  of  translational  acceleration  com¬ 
mands,  the  V  option  can  be  used  only  for  attitude  control. 
The  other  three  options  can  be  used  for  translational  and/or 
rotational  control. 

In  the  PZI  option,  no  jets  are  fired  that  would  expel 
propellant  directly  upward  with  respect  to  the  Orbiter  body. 
Translational  acceleration  in  the  downward  direction,  if 
commanded,  is  achieved  (at  a  comparatively  high  propellant 
cost)  by  firing  the  +X  and  -X  thrusters  simultaneously.  The 
cant  angles  of  the  +X  jet  and  -X  jet  thrust  lines  produce  a 
small  net  acceleration  in  the  +Z  (downward)  direction.  This 
option  normally  is  used  only  when  the  Orbiter  is  maneuvering 
in  the  near  vicinity  of  a  payload  that  must  be  protected 
from  jet  plume  impingement. 

The  digital  auto  pilot  controls  the  attitude  and  trans¬ 
lation  of  the  Orbiter  for  both  automatic  and  manned 
maneuvers  by  specifying  the  appropriate  commands  to  the  pri¬ 
mary  and  vernier  reaction  control  system  (PRCS/VRCS)  jets. 
The  crew  uses  the  DAP  panel  (Figure  1)  to  exercise  vehicle 
control.  The  DAP  panel  consists  of  hardware  pushbuttons 


that  allow  the  crew  to  select  the  translation  DAP 
auto/ manual  control  operations  sequence;  to  determine 
whether  A  or  B  DAP  configuration  values  will  be  used  with 
auto/manual  control;  to  select  translational  control;  and  to 
determine  if  primary  or  vernier  jets  will  be  commanded  to 
fire.  Appendix  A  contains  a  detailed  description  of  the 
functions  of  the  DAP  control  panel. 

The  precalculated  acceleration  and  propellant  consump¬ 
tion  information  for  each  thruster  in  the  RESPONSES  data 
file  is  read  at  the  beginning  of  the  program  and  stored  in 
array  JETSEL.  Once  the  program  has  determined  which  thrus¬ 
ters  are  to  be  fired,  the  elements  of  the  rows  in  JETSEL 
(Table  3)  corresponding  to  those  thrusters  are  summed.  This 
yields  net  vectors  for  translational  and  rotational 
acceleration  as  well  as  propellant  loss  rate  from  each  tank. 
The  elements  corresponding  to  acceleraton  in  array  JETSEL 
are  not  recomputed  to  account  for  propellant  loss  during  the 
simulation. 


\-*y» 
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4.  DETERMINING  POSITION  AND  ATTITUDE 


The  Orbiter  translational  accelerations,  once  computed, 
are  added  to  the  orbital  drift  accelerations.  These 
accelerations  are  then  integrated  twice  to  yield  velocity 
and  position.  Attitude  is  determined  by  applyinq  rotational 
accelerations  to  the  present  quaternions. 

The  Clohessy-Wiltshire  equations  for  terminal 
rendezvous/dockinq  are  used  to  model  orbital  drift.  These 
are  linearized  equations  of  motion  for  an  interceptor  vehi¬ 
cle  relative  to  a  tarqet  vehicle  in  a  circular  orbit  with 
Keplarian  motion . 


•  • 
x 


v  -  ^ 


f  '  +  3ui  y  +  2uix 

y  y 


z  = 


f  '  -  IU  z 
z 


(9) 

(10) 
(ID 


where  f  ',  f  and  f  *  are  the  Orbiter  translational 
x  y  z 

acceleration  components  (due  to  thrust),  and  ui  is  the  rota¬ 
tion  rate  of  the  tarqet  about  the  planet. 

The  tarqet  frame  is  a  right  handed  orthoqonal  system 

where  x  is  the  direction  of  tarqet  velocity,  y  is  the  zenith 
direction  (alonq  tarqet  radius  vector),  and  z  is  out  of 
orbital  plane  (opposite  the  angular  momentum  vector).  For 
further  explanation  and  derivation  of  Equations  9-11  refer 
to  Appendix  B. 

The  translational  accelerations  due  to  drift  and  thrust 
are  summed  in  Subroutine  THRUST  and  then  integrated  in  Sub¬ 
routine  LINTEG.  LINTEG  is  a  first  order  Euler  integrator 
which  was  chosen  for  fast  computational  speed  (needed  in 
real  time  simulation)  in  liqht  of  the  fact  that  accelera¬ 
tions,  and  hence  error,  will  be  small. 

The  rotational  accelerations  are  transformed  from  the 
body  frame  to  the  reference  (taraet)  frame  by  Subroutine 
BTOR.  These  accelerations  are  then  used  by  Subroutine 
ROTATE  to  determine  a  new  attitude  quaternion  and  transfor¬ 
mation  matrix.  The  equations  used  in  Subroutine  ROTATE  are 
included  in  Appendix  C. 


5.  GENERATION  OF  VISUAL  DISPLAY 


The  simulator  uses  an  Evans  and  Sutherland  PS 300  com¬ 
puter  for  visual  display.  Three  dimensional  object  data  are 
loaded  and  stored  in  the  mass  memory  of  the  PS300  at  the 
beginning  of  the  program.  These  data  are  then  rotated, 
translated,  and  displayed  repeatedly  as  commanded  by  the 
main  program  from  the  VAX  11/780. 

Subroutine  PS300  is  responsible  for  loading  the  object 
data,  known  as  vector  lists,  and  providing  a  hierarchy  of 
rotation,  translation  and  viewing  commands  for  later  input 
by  Subroutine  LOOK.  The  vector  lists  consist  of  a  spherical 
outline  of  the  earth's  continents,  a  star  sphere,  a  circular 
horizon,  target  satellite,  and  heads-up  display  imagery. 
The  reference  coordinate  system  is  the  Clohessy-Wi ltshi re 
system,  centered  at  the  target  and  described  in  detail  in 
Appendix  B. 

The  earth's  vector  list  is  scaled  at  one  distance  unit 
(DU)  and  rotated  about  its  axis  at  the  rate  of  15  degrees 
per  hour.  The  earth  is  then  inclined  and  counter- rotated  a 
rate  equivalent  to  the  angular  rate  of  the  target  orbit. 
Finally,  it  is  translated  in  the  -Y  direction  an  amount 
equal  to  its  radius  plus  target  altitude.  To  complete  the 
earth  picture  a  horizon  circle  is  added  and  the  earth  vector 
list  is  clipped  to  prevent  viewing  beyond  the  horizon. 

The  star  vector  list  is  triplicated  and  rotated  no 
degrees  about  each  axis  to  create  a  unit  sphere  of  stars. 
This  representation  does  not  reflect  true  star  positions. 
The  sphere  is  scaled  up  by  a  factor  of  one  earth  radius  plus 
twice  target  altitude  and  set  counter-rotating  (as  was  the 
earth).  The  star  sphere  is  then  translated  in  the  -Y  direc¬ 
tion  an  amount  equal  to  one  DU  plus  target  altitude  and 
clipped  so  no  stars  appear  below  the  horizon. 

The  target  vector  list  is  scaled,  placed  at  the  center 
of  the  reference  coordinate  system,  and  rotated  at  fifty 
degrees  per  minute  to  give  the  effect  of  a  spinning  satel¬ 
lite.  It  is  not  clipped  and  remains  at  the  origin 
throughout  the  simulation. 

Heads-up  display  information  includes  on  screen  printout 
of  range,  range  rate,  fuel  used,  and  elapsed  time  in  the 
upper  left  hand  corner.  The  upper  right  hand  corner  gives 
an  X-Y  plane  view  of  the  shuttle  and  predicted  future  posi¬ 
tion  in  five  minute  increments.  The  increment  markers 


appear  as  small  diamonds  originating  from  the  shuttle 
silhouette.  Affixed  to  the  target  are  radius,  velocity,  and 
out-of-plane  arrows  to  facilitate  quadrant  determination.  A 
fixed  reticle  is  also  displayed  to  help  the  operator  judge 
target  drift. 

Subroutine  LOOK  uses  shuttle  position  and  attitude  data 
relative  to  the  target  to  continuously  update  rotation, 
translation,  and  viewing  of  all  the  predefined  vector  lists. 
Current  position  and  attitude  are  used  to  generate  three 
viewing  vectors  in  the  reference  (target)  frame:  AT,  FROM, 
and  UP.  AT  is  the  line  of  sight  vector,  FROM  is  the  posi¬ 
tion  vector  and  UP  is  the  overhead  vector  (perpendicalur  to 
AT).  The  Evans  and  Sutherland  PS300  uses  these  viewing  vec¬ 
tors  to  scale,  translate,  and  re-orient  the  stored  images 
for  perspective  viewing.  Figure  1  shows  the  relationship  of 
the  stored  images  to  each  other  and  how  they  are  viewed 
given  AT,  FROM  and  UP  vectors. 
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LVLH  -  With  DISC  RATE  selected  in  all  three  axes  and  with 
the  LVLH  mode  selected,  the  attitude  that  existed  at  the 
time  of  selection  of  LVLH  will  be  held  fixed  within  the  LVLH 
frame  until  changed  by  use  of  the  RHC.  The  RHC  can  be  used 
with  LVLH  selected  to  change  LVLH  attitude.  When  the  RHC 
returns  to  detent,  the  LVLH  attitude  begins  to  be  held  fixed 
again.  This  mode  would  be  used  manually  for  precise  PROX  OPS 
attitude  control  in  the  near  vicinity  of  a  payload. 

NORM  VERN  JET  SELECT  -  Primary  RCS  (PRCS  or  NORM)  and  ver¬ 
nier  RCS  ( VRCS  or  VERN)  jets  can  be  used  for  attitude  hold 
and  maneuvers.  NORM  jets  must  be  selected  for  translation 
maneuvers.  With  primaries  selected,  there  is  a  choice  of 
jets  as  shown  in  Tables  5-7. 

Translation  Submodes  (NORM  Jets  Required) 

PULSE  X,  Y,  or  Z  -  With  this  submode  selected,  each 
deflection  of  the  THC  will  result  in  a  change  in  velo¬ 
city  of  the  magnitude  prespecified  in  the  program.  (DAP 
A  yields  .05  feet  per  second,  DAP  B  yields  .01  feet  per 
second) . 

NORM  X,  Y,  Z  -  With  one  of  these  submodes  selected, 
continuous  acceleration  will  occur  at  whatever  level  is 
available  with  the  commanded  jets  for  the  axis  and 
direction  (+  or  -)  of  the  THC  deflection. 

HIGH  Z  -  An  ACCEL  submode  that  is  available  for  +z 
translation  only.  Selection  of  this  submode  fires  more 
jets  than  are  fired  for  the  NORM  +Z  command  (Table  7). 

LOW  Z  -  LOW  Z  is  a  submode  that  takes  advantage  of  some 
+Z  thrust  components  that  exist  for  both  the  +X  and  -X 
translation  jets  (Table  6) .  To  get  the  +Z  translation, 
the  +X  and  -X  translational  jets  are  fired  simultane¬ 
ously  so  that  the  jets  nearly  cancel  the  X  components 
of  each  other  and  combine  the  small  Z  components.  The 
result  is  a  small  +Z  velocity  change.  This  mode  was 
added  because  it  provides  translation  away  from  a 
deployed  payload  without  firing  thrusters  in  the  direc¬ 
tion  of  the  payload  (thus  minimizing  plume  impingement) 
as  would  the  other  +Z  translation  submodes.  LOW  z 
translations  also  affect  pitch  and  roll,  since  only 
downfiring  jets  are  used.  This  results  in  significant 
-Z  translational  cross-coupling,  but  reduces  the  duty 
cycle  for  attitude  maintenance. 
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Manual  Rotational  Submodes 

DISC  RaTe  -  ROLL,  PITCH,  or  YAW  -  When  the  DAP  mode  is 
manual,  the  submode  is  DISC  RATE  and  the  RHC  is 
deflected  out  of  the  detent  in  an  axis,  jets  are  fired 
until  an  angular  rate  is  achieved  in  that  axis  equal  to 
the  preprogrammed  rate  (DAP  A  yields  .000873  radians 
per  second,  DAP  B  yields  .000175  radians  per  second). 
When  the  rate  is  achieved  the  jets  are  turned  off  until 
the  RHC  is  returned  to  detent  in  that  axis  unless  the 
jets  are  momentarily  required  to  maintain  attitude  or 
rates  within  deadbands.  When  the  RHC  is  returned  to 
detent  in  an  axis,  the  attitude  in  that  axis  is 
snapshotted  and  jets  are  fired  to  stop  the  rate  and  to 
begin  holding  the  snapshotted  attitude. 

ACCEL  -  ROLL,  PITCH,  YAW  -  When  the  DAP  mode  is 
MAN/ACCEL  and  the  RHC  is  deflected  out  of  detent,  a 
fixed  number  of  jets  are  fired  to  provide  constant 
angular  acceleration.  When  the  RHC  is  returned  to 
detent,  the  jets  are  turned  off  but  the  angular  rates 
continue.  The  result  is  a  free  mode  since  the  attiude 
is  uncontrolled  when  the  RHC  is  in  detent  'free  drift 
at  the  existing  angular  rates). 

PULSE  -  ROLL,  PITCH,  or  YAW  -  When  the  DAP  mode  is  in 
MAN/PULSE  and  the  RHC  is  deflected  out  of  detent;  jets 
are  fired  just  long  enough  to  achieve  the  preprogrammed 
angular  rate  (DAP  A  yields  .3  radians  per  second 
squared,  DAP  B  yields  .06  radians  per  second  squared). 
PULSE  is  also  a  free  mode. 

RHC  and  THC  -  The  handcontr oilers  are  used  to  input  commands 
to  the  DAP,  which  then  (depending  on  DAP  configuration)  out¬ 
puts  appropriate  RCS  jet  fire  commands. 
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APPENDIX  B 

(This  appendix  was  taken  wholly  from  Reference  4) 


TERMINAL  RENDEZVOUS /DOCKING 


This  appendix  develops  the  equations  of  motion  for  an 
interceptor  vehicle  relative  to  a  target  vehicle  in  orbit 
about  a  central  body  when  the  range  between  vehicles  is  less 
than  R  km  (5  mi les ) . 


The  following  approach  will  be  taken  to  solve  this 
engineering  problem. 


1. 


Establish  a  coordinate  system: 

a.  Origin  at  target  vehicle 

b.  Orthogonal  right-handed  system 

c.  x  —  In  the  local  horizontal,  in 

direction  of  target 
vehicle  velocity  vector 

d.  y  —  In  zenith  direction  (along 

target  vehicle  position 
vector  R) 

e.  1?  —  Vector  to  target  in  fixed 

frame 

f.  IP  —  Vector  to  interceptor  in 

fixed  frame 


A 


Figure  3 


g.  p  «=  r  -  R  —  position  of  the  interceptor  relative  to 

the  target. 

2.  Apply  Z  F@xt  =  -^(mv)  i°  the  rotating  coordinate  system: 

a.  This  is  a  double  application  of  the  law  of  coriolis 
for  derivatives  in  a  rotating  frame.  (If  you  can't  derive 
this,  see  BMW  pp.  92-93.) 


d2(  ) 
dt2 


F 


„  cT(  ) 

dt2 


R 


+  UiX(  )  +  oix  U1X  (  )+?uix 


d(  ) 

~wr 


R 
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b.  When  (  )  is  the  position  of  the  interceptor  vehicle, 
(7),  then 


.3=  Z  7  ext  -  I  -I 

=  - - -  =  7  =  r  p  +  uix  r  +  m  x  in  x  r  +  2  uix  r 

dt2  F  m  R  R 


c.  Noting  the  following  relationships 


( 1 )  in  »  -in 


(7)  -R  R  =  R  p 


(  2 )  in  *  -ui  £ 


(9)^r=R? 


(3)  p^xSi+y^+zS;  (9)  r  =  x  Sc  +  (R  +  y)  £  +  z  £ 


(4)  pR=x£  +  y$+zz 


(5)  pR=x£+y$+z£ 

(6)  T*  =  R  $■ 


(10)  rR=xX+  (R+y)  $  +  z  i 


(11)  rR=x*+(R+y)£+zfc 


d.  Developing  the  required  cross  products 


ui  x  r  =  in( R  +  y)  x  -  act  p 


in  x  r  =  ui(R  +  y)  x  -  inx  £ 

in  x  in  x  r  =  -u?'  xx-u^(R+y)  £ 


e.  Now  substituting  from  c  and  d  into  the  component 
form  of  the  vector  equation  developed  in  2.b,  we  obtain 

fx=  x  +  in(R+y)  -  u^x  +  ?ui(R  +  y) 

•  •  •  •  •  «  • 
fy=  R+y-iux  -  ur  ( R  +  y)  -  2uk 
•  • 

fz  “  z 
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£.  Now,  let  i  be  the  specific  force  other  than  the 
gravitational  attraction  of  the  central  body  (i.e.,  drag, 
thrust,  solar  pressure,  etc.) 


T-T'  +  T  m  T  -  t 
9  73 


OR 


f  -  f  '  -  H* 
x  x  ^5 


f  _  f  t  Y) 


y  y 


f  -  f  '  -  £1 


z  X.  r3 


g.  Then  the  relative  motion  is  described  by 


x  ■  £  '  -  ui(R  +  y)  +  u?x  -  2uj( R  +  y)  -  H* 

r3 


y  »  £  '  -  R  +  uk  +  u?(R  +  y)  +  2 uk  -  ^  R  t  Y— 


2  A  ,2,3/2 


*  *  *-*  ~  where  r3  =  fx2  +  (R  +  y)2  +  z2] 

z  r3 


THESE  ARE  VERY  NON-LINEAR,  BUT  EXACT  EQUATIONS  OF  MOTION. 


3.  Linearize  the  equations  to  find  an  analytic  solution: 
r3  -  R3  [(*)2  +  (1  +  J)2  +  (z)2]3/? 

«  R3  Cl  +  +  (|)2  +  <£)2  +  (|)213/2 

a.  Since  x,  y  and  z  are  small  compared  with  R, 
r3  Z  r3(1  +  ^f.)3^2 


iBWRWLmmWl  !W , 


.■ .  rrrr  *t?".  ^rrrrr. 
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b.  Then  the  last  terms  in  the  equations  of  2.g.  take  on 
the  form 


_  P  - 

75  “ 


'(1  + 


3/2 


c.  Since  the  term  (Y)  is  small  (less  than  0.00125),  use 
the  binominal  expansion  to  begin  to  simplify  these  equations 


(i  +  «r3/2  =  1-3 


+  15  <2  _ 


d.  Then,  substituting  into  2g  and  neglecting  the  small 
high  order  terms. 


px 


R3(l  +  2£)' 
So  that 


-  H*  +  1BSX.  ,  etc. 
R3  R4 


*  *  V 


y  -  V 


Z  =  f  ' 
z 


ui(R  +  y)  +  u?x  -  2ui(R  +  y)  -  +  3p*~y 

R3  R 


-  R  +  UK  + 


u?(R  +y)  +  2ui-JL+2PX+3ily: 


R3 


pz  +  3pzy 
R3  R4 


e.  The  only  nonlinear  terms  are  the  last  ones  in  the 
equations.  These  terms  are  smaller  than  the  proceeding 
terms  by  (^) .  Neglecting  these  terms  results  in 

V  =  f  '  -  cu(R  +  y)  +  (u?  -  iL)x  -  2u/r  +  y) 

X  R3 

y=f'-R+UK  +  (u?  -  -iL)R  +  (u?  +  — £)y  +  ?uk 
y  R3  R3 


v  1 


(liut 
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4.  Now  ASSUME  the  target  vehicle  is  in  a  CIRCULAR  orbit 


a .  Then 


b.  The  equations  of  motion  become 


•  •  • 

x  *  fx*  -  2uy 

y  =  f  '  +  3u?y  +  2  u* 

z  »  f z'  -  u?z 

THESE  ARE  THE  LINEARIZED  EQUATIONS  OF  MOTION  FOR  AN  INTER¬ 
CEPTOR  VEHICLE  RELATIVE  TO  A  TARGET  VEHICLE  IN  A  CIRCULAR 
ORBIT  WITH  KEPLAIHaN  MOTION. 


APPENDIX  C 


(This  appendix  was  taken  wholly  from  Reference  5) 


ATTITUDE  DETERMINATION  USING  QUATERNIONS 


The  quaternion  q  describing  the  orientation  of  a  body  with 
respect  to  a  reference  coordinate  frame  may  be  found  by 
integrating  the  quaternion  differential  equation: 


UJ 

q  =  q  7 


where 


*<*1  +  Dq,  +  ftq- 


Ul  *  lu^  +  +  ftu^ 


ui  =  rate  of  rotation  of  body  with  respect  to  the 
reference  frame  (in  body  coordinate  frame). 


Expansion  of  (1)  yields  the  following  form: 


U4,  -lUy  U* 


The  quaternion  components  in  the  body  (X,  Y,  Z)  coordinate 
frame  are 


where 


q->  = 


“k 

UJ 

sin 

ut 

~T 

UJ 

s  in 

at 

TT 

Ul 

s  in 

at 

~T 

at 

COS  ~y 

\  + 

4 

(3) 


A  vector  is  transformed  from  body  to  reference  coordinates 
by 


XR  =  qXBq*  U) 

where 

q*  =  -Iq^  -  ^  -  Ra3  + 

=  conjugate  of  q 
qq*  =  q*  q  =  1 


The  equivalent  equation  in  vector-matrix  notation  is 


If  (4)  and  (*>)  are  expanded  and  compared,  it  is  seen  that 


_2  -7  „2.„2 
ql_q2  q3+q4 

2(qiq2+q3q4) 

2(qlq3-q2q4> 


2(qiq2-q3q4)  2(q1q3+q?q4) 

_ql+q2"‘q3+q4  2  ^  q2q3_qlq4  ^ 

2(q2q3+q1q4)  “ql~q2+q3+qA 


(ft) 


From  (6),  the  quaternion  components,  expressed  as  functions 
of  the  matrix  elements,  are 


THIS  PROGRAM  GENERATES  ROTATIONAL  AND  TRANSLATIONAL  ACCELERATIONS 
AND  ASSOCIATED  FUEL  COSTS  FOR  EACH  THRUSTER  AND  STORES  THEM  IN 
ARRAY  "THRUST".  TO  DO  THIS  IT  APPLIES  EACH  THRUSTER*  S  FORCE 
AND  POSITION  ON  SHUTTLE  BODY  (STORED  IN  ARRAY  ’JET*)  TO  SHUTT  V 
MASS*  CG*  AND  MOMENTS  OF  INERTIA. 

FOR  A  DETAILED  EXPLANATION  OF  EQUATIONS/PARAMETERS  REFER  TO 
TRW  PAPER  "ENGINEERING  DESCRIPTION  OF  THE  CMS/RCS/DAP  MODELS 
USED  IN  THE  HP-9325A  HIGH  FIDELITY  RELATIVE  MOTION  PROGRAM  (HFRMPT 
6  OCT  78.  OR  SEE  CAPT.  ALFANO*  DF AS 

REAL  MASS*STACG*BLCG*WLCG*RX*RY*RZ 

REAL  MOI(3*3)*IMOI(3*3)*JET(44*12)*THRUST(44*9) 

REAL  VUN(12)*PUN(12)*PZIUN(12)*PZHI(12) 

INTEGER  I*J*TYP£*TABLE (4*1 2*°) * IOSTAT 


SELECTION  TABLES  ARE  AS  FOLLOWS: 

DATA  (TA8LE(1*1*I)*I=1*9) /9*0/ 

DATA  (TABLE(1*2*I)*I=1*9)/9*Q/ 

DATA  (TABLE(1*3*I)*I=1*9)/9*0/ 

DATA  (TABL£(1*4*I)*I=1*9)/9*0/ 

DATA  <TABLE(1*5*I)*I=1*9)/9*0/ 

DATA  (TABLE(1*6*I)*I=1*9>/9*0/ 

DATA  (TABLE (1*7* I) *1=1 *9)/ 44 *8*0/ 

DATA  (TABLE (1*8* I) *1=1 *9)/43*8*0/ 

DATA  (TABLE (1*9,1) *1=1 *9)/ 39*40*7*0/ 

DATA  (TABLE (1*10*1) *1=1 *9 )/44*43*7*0/ 

DATA  (TABLE (1*1 1*1) *1  =  1* 9) /A  1,8*0/ 

DATA  (TABLE (1*12*1) *1=1*9) /42* 8*0/ 

DATA  (TABLE (2* 1*1) *1=1 *9) /I  6*1 3*7*0/ 

DATA  (TABLE (2* 2* I) *1=1 *9) /I *3* 7*0/ 

DATA  (TABLE (2*3*1) *1=1 *9) /4*1 9,7*0/ 

DATA  (TABLE (2*4*1) *1=1  *  9 ) / 6  *  23  *  7*0/ 

DATA  (TA3LE (2*5*1) *1=1 *9)/ 9* 27* 30*6*0/ 

DATA  (TABLE (2*6*1) *1=1 *9) /I  2*1 1*33*34,36*37, 3*0/ 
DATA  ( TABLE (2*7*1) *1=1 *9) /33* 3 0*7*0/ 

DATA  ( TABLE <2*8* I) *1=1 *9) /2 7*3 6* 7*0/ 

DATA  (TABLE (2*9,I)*I=1*9>/12*11*27*30*5*0/ 

DATA  (TABLE (2*10*1), 1=1 *9)/ 9*3 3*36* 6*0/ 

DATA  (TABLE <2*1 1*1) *1=1 *9) 74*23*7*0/ 

DATA  (TABLE (2* 12* I)* 1=1*9) /6*1 9*7*0/ 

DATA  (TABLE (3* 1*1) *1=1 *9) /I  6*13*7*0/ 

DATA  (TABLE (3*2*1) *1=1 *9) /I* 3* 7*0/ 

DATA  (TABLE (3*3* I) *1=1 *9)/ 4* 19, 7*0/ 

DATA  (TABLE (3*4*1) *1=1 *9) /6* 23*7*0/ 

DATA  (TA3LE(3*5*I)*I=1*9)/1*3*16*18*5*0/ 

DATA  (TABLE (3*6* I) *1=1 *9) /I  2*1  1*  33*34*36*37*  3*0/ 
DATA  (T ABLE (3*7*1). I =1*9)/33*8*0/ 

DATA  (TABLE(3*8*I)*I=1*9)/36*8*0/ 

DATA  (TA8LE (3*9*I)*I*1*9)/1 2*1 1*7*0/ 

DATA  (TABLE (3*10*1)* 1*1 *9) /33*36*7*0/ 

DATA  (TABLE (3* 1 1*1) *1=1 *9) /4*2 3*7*0/ 

DATA  (TABLE (3* 12*I)*I=1*9)/6*19,7*0/ 

DATA  (TABLE (4* 1*1) *1=1 *9) /I  6*1 3*7*0/ 

DATA  (TABLE (4,2*I)*I=1*9)/1*3*7*C/ 

DATA  (TABLE (4*  3*1) * I=1*9)/4*19*7*0/ 
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DATA  (TABLE (4,4,1) / 1*1, 9) 76,23,7*07 

DATA  (TABLE (4, 5, I), I *1,9) 78, 9, IQ, 27, 28, 29, 30, 31, 327 
DATA  (TABLE (4/6/1) #1=1 #9) 712/1 1/33/ 34# 36/ 37# 3*0/ 

DATA  (TABLE (4/7# I) #1*1 #9)733/30/7*07 
DATA  (TABLE (4/8# I)/ 1*1 #9) 727/36/7*07 
DATA  (TABLE (4/9# I) #1 *1/9) 71 2/1 1/27/30/5*07 
DATA  (TABLE (4# 10/1) #1*1 #9) 79/3 3/ 36/ 6*07 
DATA  (TABLE (4/1 1/1) #1*1 #9) 74/23/ 7*07 
DATA  (TABLE (4/12/1) #1*1 #9) 76/1 9/7*07 

ASSIGN  VALUES  TO  JET  ARRAY 

DATA  (JET (1/1) #1*1 #9) 7-879. 4, -26. 2/ 11 9. 9, 306. 72# 14. 65# 392. 96, 
*0/3.1071/17 

DATA  (JET (2/ I) #1*1 #9) 7-879. 5/0. 0/1 22. 7# 306.72,0.0/394.45/0.0/ 
*3.1071/17 

DATA  (JET (3, I >,1*1,9)7-879. 4,26. 2, 11 9. 9, 306. 72, -14. 65, 392. 96, 
*0.0/3.1071,17 

DATA  (JET (4# I), 1*1 #9) 7-26. 3/ 873. 6/ 18. 2# 362. 67,-69. 5/ 373.73/ 
*0.0/3.1071/1 7 

DATA  ( JET(5/I) ,1*1/9) 7-21. 0/870.3/. 5/364. 71 ,-71 .65/359.25,0.0/ 
*3.1071/17 

DATA  (JET (6/ I) /I *1/9) 7-26.3/ -87 3. 6/1 8.2/362.67/69.5,373.73/ 
*0.0/3.1071,17 

DATA  (JET(7,I) ,1*1 ,9)7-21 .0,-870.3/0.5/364.71/71.65/359.25/ 
*0.0/3.1071/17 

DATA  (JET (8, I), 1*1 ,9) 7-32.3,-11.7/874.4/350.93/14.39/413.46/ 
*0.0/3.1071,17 

DATA  (JET(9, I), 1*1 ,9) 7-31. 9,0. 0/8 73. 5/ 350. 92/0. 0/41 4. 5 3, 
*0.0/3.1071,17 

DATA  (JET (10, I) ,1*1/ 9)7-32.3/11.7/874.4/350.93,-14. 39/41 3. 46, 
*0.0/3.1071,17 

OATA  (JET(1 1/1), 1*1/ 9)7-28.0,-61 6. 4,-639. 5/333. 84,61. 42, 356.95, 
*0.0/3.1071,17 

OATA  (JET(1 2, I) ,1*1/ 9)7-28.0/616.4,-639. 5/333. 84,-61 .42/356.95, 
*0.0/3.1071,17 

DATA  (JET (13/ I) ,1*1/ 9)7-24.8,-61 2. 6,-639.4/ 348.44/ 66. 23,3 58.44/ 
*0.0,3.1071/17 

DATA  (JET (14, I), 1*1 ,9) 7-24.8 ,612. 6,-639.4, 34 8. 44,-66. 2 3,358.44, 
*0.0/3.1071,17 

DATA  (JET (15/ I), 1*1 ,9) 785 6. 8/0.0, 15 1.1,1 5 5 5. 29,1 37. 0,473. 06, 
*0.0/3.1071,27 

DATA  (JET (16/ I) ,1*1 ,9) 7856.8/0.0/151.1,1555.29/124.0,473.06/ 
*0.0/3.1071,27 

DATA  (JET (17, I), I *1,9) 7 85 6. 8, 0.0/151. 1/1555. 29, -137. 0,473. 06, 
*0.0,3.1071/37 

DATA  (JET (18/ I) /I *1/9) 7856. 8/0. 0/1 51. 1,1555. 29, -124. 0,473. 06/ 
*0.0/3.1071/37 

DATA  (JET (19, I), I *1,9) 70. 0, 870 . 5 ,- 8. 4, 1 51 6 . 06,-1 49. 83, 45 5 . 2 1 , 
*-0.5887,3.1071/37 

OATA  ( JET (20/ I) /I *1/9) 70.0, 870. 5 /-8. 4,1 5 29.07,-1 49.83/455.21, 
*-0.6061/3.1071,37 

DATA  (JET (21 ,1)/I*1 ,9) 70. 0/870.5,-8.4,1542.07,-1 49. 83/ 455. 21, 
*-0.6235/3.1071/37 

DATA  (JET(22,I) ,1*1/9) 70.0/870.5,-8.4/1555.07,-149.83/455.21/ 
*-0.6410/3.1071,37 

DATA  (JET (23/ I) ,1*1 ,9) 70.0/ -870. 5, -8. 4/1 51 6.06/1 49. 83/ 455. 21, 
*0.5887,3.1071 ,2/ 

DATA  (JET (24, I), I *1,9)70.0,-870.5,-8. 4 ,15 29. 07, 149. 83/ 45 5. 21, 
*0.6061,3.1071,27 


DATA  (JET(25*I)*I=1*9)/G.Q*-870.5*-8. 4*1542.07*149. 83*455. 21* 
*0.6235*3.1071*2/ 

DATA  ( J ET(26* I) *1  =  1  *  9) /0. 0,-87  0. 5,-8. 4*1 5  55.07*1 49. 83*455. 21,  \ 

*0.641*3.1071*2/ 

DATA  <JET<27*I> *  1  =  1* 9) /29.0*72. 0*870.0*1 520.04*-1 16. 51*4S1.65* 
*-0.4615*3.1071*3/ 

DATA  (JET (28* I) *1*1 *91/29.0*72.0* 870.0*1 532.96**116.54*481.65* 
*-0.3725*3.1071*3/ 

DATA  (J ET (29* I) *  1=1 *9) /29.0* 72. 0*870. 0*1 545. 87**116.58*481. 65* 
*-0.2836*3.1071*3/ 

DATA  (JET(30*I)*I=1*9J/29.0* -7 2. 0*870.0* 1520. 04 *116.51*4 81 .65* 
*0.4615*3.1071*2/ 

DATA  (JET (31*1 )*I=1 *9) /29.0*-72.0*870. 0*1 532.96*116.54*481.65* 
*0.3725*3.1071*2/ 

DATA  ( JET (32* I) *1=1*9) /29.0*-7 2.0* 870. 0*1 545. 87, 116.58*481. 65* 
*0.2836*3.1071 *2/ 

DATA  (JET (33* I) *1=1 *9)/ 31 2. 4* 346. 8,-545.7* 1498. 11 *-101. 47*420.49* 
*1.7413*3.1071*3/ 

DATA  (JET(34*I)*I=1*9)/312.4*346. 8,-545. 7* 151 3.68,-100.61*424. 63* 
*1.4807*3.1071*3/ 

DATA  (J ET(35* I) *1=1 *9) /31 2.4*346. 8,-545.7*1 529. 23,-99. 79*428. 76* 
*1.2203*3.1071*3/ 

DATA  (JET(36*D*  1  =  1  *9)/ 31  2.4*- 346. 8,-545. 7*1 498. 11  *101.47*420. 49* 
*-1.7413*3.1071*2/ 

DATA  (JET (37* I) *1=1 *9) / 31 2.4,-346. 8,-545. 7*1 51 3. 68*1 00.61 *424.63* 
*-1.4807*3.1071*2/ 

DATA  (J ET( 38* I) *1=1* 9) /31 2. 4,-346. 3,-545. 7*1 529. 23*99.79*428. 76* 
*-1.2208*3.1071 *2/ 

DATA  (JET(39*I)*I=1*9)/-0. 8,-17. 0,-17. 6*324. 35*59. 7*350. 12* 

*0.0*.  0923*1/ 

DATA  ( JET (40*1 )* 1*1*9) /-0.8*1 7. 0,-17. 6*324. 35,-59. 7*350. 12*  w 
*0.0*. 0923*1/ 

DATA  (J ET(41* I) *1=1 *9) /0. 0,-24.0,-0.6*1565.0* 149.87*459.0* 

*0.0*. 0923*2/ 

DATA  (J ET (42* I) *1=1 *9) /O.O* 24. 0,-0.6*1565. 0,-149.87*459.0* 

*0.0*. 0923*3/ 

DATA  ( J ET (4 3* I) *1=1* 9) /O. 0*0. 0,-24. 0*1 565.0* 11 8. 0*455. 44* 

*0.0*. 0923*2/ 

DATA  (JET (44* I) *1=1* 9) /O. 0*0. 0,-24.0*1565.0,-1 18. 0*45 5.44* 
*0.0,-0923*3/ 

REASSIGN  VALUES  TO  JET 

DO  900  1=1*44 

JET(I*11)=JET(I*8) 

JET(I*12)=JET(I*9) 

CONTINUE 

NAS$*200017.0/32.2 
NO I ( 1  * 1  )  =  887302.00 
NO 1(2*2)= 63 86877.0 
NOI(3*3)= 66 94367.0 
NO I (1*2)= -5 622.0 
NOI(2*1)=-5622.0 
N01(2*3)=971.0 
NOI ( 3*  2 ) =97 1.0 
N0I(1*3)=-247376.0 
N0I(3*1 )=-247376.0 
ST  AC  G*1 09  5.3 
3LCG=0. 3 
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WLCG-377.4 

C 

PRINT  *#'  DO  YOU  WISH  TO  USE  NOMINAL  SHUTTLE  PARAMETERS? * 

PRINT  **•  TYPE  1  FOR  YES*  2  FOR  NO* 

READ  **TVPE 

IF  (TYPE  .EQ.  2)  THEN 

PRINT  **'  ENTER  SHUTTLE  MASS  <L8S>* 

READ**MASS 

C  CONVERT  TO  SLUGS 

MASS*MASS/32.2 

PRINT  ***  ENTER  MOMENTS  OF  INERTIA  C$LUG-FT**2) * 

PRINT  **•  IXX*1YY*IZZ  (BODY  FRAME)* 

RE AD**MOI (1*1)*MOI(2*2)*MOI(3*3) 

PRINT  **•  ENTER  IVZ*IZX*IXY* 

READ**MOI (2* 3)* MOI (3*1 )*MOI(1*2) 

MOI (2*3)*”MOI<2*3> 

MOI  (3*1  )*-MOI (3*1  > 

MOI (1 *2>*-MOI(1*2> 

MOI (3*2) *MO I (2* 3) 

MOI (1 *3>*MOI (3*1 ) 

MOI (2*1 )*HOI(1*2> 

PRINT  ***  ENTER  SHUTTLE  CS  (INCHES)* 

PRINT  ***  CG  STA*  C6  BL*  CG  WL* 

READ  **STACG*BLCG*WLCG 
ENDIF 

PRINT  ***  *******  ECOCHECK  OF  SHUTTLE  DATA  ******* 

PRINT  ***  SHUTTLE  MASS  *  **MASS*32.2 
PRINT  **•  IXX  *  **MOI(1*D 
PRINT  ***  IVY  *  *  *HOI ( 2*2 ) 

PRINT  •**  IZZ  *  **M0I(3*3) 

PRINT  **«  IYZ  *  **-MOI(2*3) 

PRINT  ***  IZX  *  * *-MOI (3*1 ) 

PRINT  ***  IXY  *  **-MOI(1*2) 

PRINT  ***  CG  STA  =  **STACG 
PRINT  ***  CG  BL  *  * *BLCG 
PRINT  **'  CG  WL  *  *  * WLCG 
C 

C  GIVEN  THE  SHUTTLE  CG  LOCATIONS  (STACG*BLCG*WLCG  IN  THE  SHUTTLE 

C  FRAME)  THIS  ROUTINE  COMPUTES  TORQUES  IN  BODY  AXIS  (LX*LY*LZ) 

C  AND  STORES  THEM  IN  COLUMNS  8*9*10  OF  ARRAY  JET.  EACH  THRUSTER 

C  HAS  ONE  ROW  OF  ARRAY  JET  ASSIGNED.  COLUMNS  ARE  AS  FOLLOWS: 

C  1-FX  2-FY  3-FZ  4-STA  5-8L  6-WL 

C  7-C  8-LX  9-LY  10-LZ  11-PROPELLANT  FLOW  RATE 

C  1 2-TANK ( 1  =  FORWARD* 2*R IGHT* 3*LE FT ) 

C 

C 

DO  175  1*1*44 

RX*-(JET(I*4)-STAC6)/12.0 

RY**(JET(I*5)-BLCG)/12.0 

RZ*-(JET(I*6)-WLCG)/12.0 

JET(I*8)*RY*JET(I*3)-RZ*JET(I*2)+JET(I*1)*JET(I*7) 

JET(I*9)»RZ*JET(I*1)-RX*JET(I*3)*JET(I*2)*JET(I*7) 

JET(I*10)*RX*JET(I*2)-RY*JET(I*1)*JET(I*3)*JET(I*7) 

175  CONTINUE 
C 

C  ESTABLISH  UNCOMPENSATED  ACCELERATION  PROFILES 

C  MOI*MOMENT  OF  INERTIA  MATRIX 

C  IMOI*INVERSE  OF  MOI 

C  VUN (  )*VERNI£R/ UNCOMPENSATED  RESPONSES 

C  PUN (  )*PRI MARY/UNCOMPENSATED  RESPONSES 
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C  PZIUN (  >*PRIMARY  WITH  *1  INHIBIT ED/ UNCOMPENSATED  RESPONSES 

C  PZHIC  )*PR IMARY  WITH  HIGH  Z/UNCOMPENSATEO  RESPONSES 

C 

CALL  INVERT(MOIzIMOI) 

CALL  JET$EL(IMOI/JET/MASS/THRJST/VUN/PUN/PZIUN/PZHI/TABLE) 

C 

C  OPEN  FILES  HERE 

C 

OPEN <UNIT*2/ NAME*' CALF ANO. DATA  3 RESPONSE S. DAT  * /TYPE* 'NEW* / 

♦  FORM* 'UNFORMATTED* /INITIALS  I ZE=4G) 

C  OPEN (UNIT* 3/ FILE* ' RSP.TBL* /STATUS** NEW*/ 

C  *  IOSTAT*ISTAT) 

C 

C  WRITE  TO  THE  FILE 

C 

105  F0RMAT(7X/I2/9(3X/F9.5>> 

DO  825  1*1/44 

WRITE (2) < THRUST (I/J)/J=1/9) 

C  WRITE(3/105)I/(THRUST(I/J)/J*1/9) 

825  CONTINUE 

DO  850  1*1/12 

WAITE (2>< TABLE <1/I/J>/J=1/ 9) 

WRITE (2) (TABLEC2/I/J)/ J*1/9) 

WRITE (2) ( TABLE <3/1/ J)/J*1/9> 

WRITE(2)(TABL£(4/I/J)/J*1/9) 

WR ITE  <2) VUN(I ) 

WRITE(2)PUN(I) 

WRITS(2)PZIUN(I) 

WRITE(2)PZHI(I) 

850  CONTINUE 
C 

C  CLOSE  FILES 

C 

CL0SE(UNIT*2) 

C  CL0SE(UNIT=3) 

C 

END 

C 

C 

C 

C 

C 

C 

c 

c 

c 

SUBROUTINE  ROWOP(MATzRC) 

REAL  MAT<  3/ 6) 

INTEGER  RC/I/J 
REAL  FACTOR 
C 

C  THIS  ROUTINE  UNITIZES  ONE  ROW  OF  A  3  BY  6  MATRIX  (MAT) 

C  ABOUT  THE  PIVOT  (RC)  AND  THEN  PERFORMS  ELEMENTARY  ROW 

C  OPERATIONS  ON  THE  REMAINING  TWO  ROWS. 

C  (TO  BE  USED  3Y  SUBROUTINE  INVERT) 

C 

FACTOR* MAT(RC/RC) 

DO  100  1*1/6 

MAT(RC/I)*MAT(RC/I)/FACTOR 
100  CONTINUE 
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DO  200  J«1/J 

IF  (J  .EQ.  RC )  60T 0  200 

IF  <ABSCMAT(J*RC))  .LE.  .0000000001)  60T0  200 
FACTOR*-MAT(J*RC)/MAT(RC*RC) 

DO  400  1*1*6 

HAT<J*I)*MAT<J*l)+NAT<RC*I)*FACTOR 
400  CONTINUE 
200  CONTINUE 
ENO 
C 
C 

c 

c 

SUBROUTINE  INVERTIMOI* INOI) 

C 

C  THIS  ROUTINE  SETS  UP  A  3  BY  6  MATRIX  (DUMMY).  LEFT  3  BY  3 

C  MATRIX  IS  THE  MOMENT  OF  INERTIA  MATRIX  (MOI).  THE  RIGHT 

C  3  BY  3  IS  THE  IDENTITY  MATRIX.  CALLS  TO  SUBROUTINE  ROWOP 

C  PERFORM  ELEMENTARY  ROW  OPERATIONS  MAKING  THE  LEFT  3  BY  3 

C  OF  DUMMY  THE  IDENTITY  MATRIX  AND  THE  RIGHT  3  BY  3  THE  INVERSE 

C  MOMENT  OF  INERTIA  MATRIX  (IMOI). 

C 

REAL  MO I ( 3* 3)* IMOI ( 3*3) *DUMMY<3*6) 

INTEGER  K*L 
C 

DO  100  K*1*  3 
DO  300  L*1*3 

DUMMY (K*L)*MOI(K*L) 

DUMMY (K*L+3)*0.0 
300  CONTINUE 

DUMMY OC*K  +  3)*1 .0 
100  CONTINUE 

CALL  R0W0P(DUMMY*1) 

CALL  ROWOP (DUMMY* 2) 

CALL  R0W0P(DUMMY*3) 

DO  150  K*1*3 
DO  350  L*1 *  3 

IM0I(K*L)*DUMMY(K*L+3) 

350  CONTINUE 

150  CONTINUE 
END 
C 

c 

c 

c 

SUBROUTINE  J ETS EL ( IMOI * J ET*M AS S* THRUST* VUN*PUN*PZIUN* 

*  PZHI*TA8LE) 

C 

C  SUMS  FORCES  AND  TORQUES  OF  THRUSTERS*  CONVERTS  TO  ACCELERATIONS 

C  ASSIGNS  PROPELLANT  LOSSES  FOR  THRUSTER. 

C 

INTEGER  I*J*TA8LE(4*12*9)*R0W*C0L 

REAL  M(12)*ALPHA(3)*IM0I(3*3)*JET(44*12)*MASS*THRUSTC44*9> 

REAL  VUN(12)*PUN(1 2)*PZIUN(12)*PZHI(12) 

C 

DO  100  1*1*44 
M(1 )*JET( I* 1 > 

M(2)*JET( 1*2) 

M(3)*JET( 1*3) 

M(4)*JET( 1*8) 


N( 5) * JET( 1*9) 

K(6)*JET(I/10) 

ASSIGNING  OF  PROPELLANT 

N(7)*0.0 
H(9)*0.0 
NC  8>  * JET ( 1/11) 

IF  ( J  ET(I /I  2)  .LE.  1.5)  THEN 
M(7)*JET (1^11) 

M(8)*0.0 

END  IF 

IF  (JET (1*12)  .GE.  2.5)  THEN 
M(9)=JET  (1/11 ) 

N(3>=0.0 

ENDIF 

CONVERT  FORCES  AND  TOROUES  TO  ACCELERATIONS 

H(1)*H(1 ) /NASS 
N( 2) SN(2) /NASS 
H( 3) *H( 3) /NASS 
DO  400  J*1/3 

ALPHA(J)*IWCI(J/1)*N(4)+IH0I(J/2)*H(5)*IM0I(J/3)*H(6) 
CONTINUE 
N( 4) = ALPHA (1 ) 

N( 5)*ALPHA(2) 

N(6)*ALPHA(3) 

ASSIGN  THRUST  ARRAY  AS  FOLLOWS 

COL  1-3  TRANSLATIONAL  ACCELERATION  (F?S2) 

COL  4-6  ROTATIONAL  ACCELERATION  (RAD/S2)) 

COL  7-9  FUEL  USED  (L8S/S)  (7-FWD  8-RT  9-LT) 

DO  200  J*  1  /  9 

THRUST( I/J)*H(J) 

CONTINUE 

CONTINUE 

ASSIGN  RATES  CORRESPONDING  TO  COWHANDS  FOR  GIVEN 
THRUST  PROFILE 

DO  500  1*1/12 
VUN(I)*0.Q 
DO  600  J*1  / 9 

IF  (T ABLE ( 1 / I / J )  .EQ.  C)  GOTO  500 
R0W*TABLE(1/I/J> 

C0L*INT((I*1>/2) 

VUN (I )* VUN( I ) ♦THRUST (ROW/CCL ) 

CONTINUE 

CONTINUE 

DO  525  1*1/12 
PUN( I )*0. 0 
DO  625  J=1 / 9 

IF  (TA0LE(2,I/J>  .EQ.  0)  GOTO  525 
R0y*TABLE(2/I/J) 

C0L*INT((IM)/2> 

PUN(I)*PUN(I)«-THRUST(ROW/CCL) 

CONTINUE 


525 

C 


650 

SO 

C 


675 

575 

C 
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CONTINUE 

00  550  1*1*12 
RZXUN<I>«0.0 
00  650  4*1*9 

XF  <TASLE<3*X*4>  .EQ.  0)  GOTO  550 
ROU*TABLE(3*X*4) 

C0l*XNT  <Cl+1)/2> 

RZIUNU>*PZIUN<I>+THRUST<ROW*COL> 

CONTINUE 

CONTINUE 

00  575  1*1*12 
PZMZCI)*0.0 
DO  675  4*1*9 

XF  (TABL£(6*I*4)  .EG.  0)  GOTO  575 
ROU*TABLE(4*I*4) 

COL*INT  C ( 1*1 )/2) 
PZHX(1)*PZHX(X)+THRUST(R0U*C0L) 
CONTINUE 

CONTINUE 

END 
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C  PRODUCED  BY  THE  UNITED  STATES  AIR  FORCE  ACADEMY 
C  DEPARTMENT  OF  ASTRONAUTICS  AND  IS  NOT  PROTECTED 
C  BY  COPYRIGHT.  <17  U.S.C.  SECTION  105) 

C  PROGRAM  IS  BASED  ON  WORK  BY  USAFA/DFAS. 

C  AUTOVON  259-4110  COMMERCIAL  503-472-4110 

CA*AA**A»AAAAAAAAAAAAAAAAA,*A*AAAAA*AAA*A*AAAAAAAAAAAA 

C 

C  EXECUTES  THRUST  COMMANDS  FOR  PROXIMITY  OPERATIONS 

C  DAP  PANEL  MODE  DEFINITIONS  CAN  BE  FOUND  IN: 

C  FLIGHT  PROCEDURES  HAND  BOOK/ PROXIMITY  OPERATIONS 

C  PRELIMINARY  NOV  11*1982  NASA 

C  PAGES  3-16  TO  3-20 

C  QUESTIONS  ?????  CONTACT  CAPT  ALFANO*  DFAS 

C 

INCLUDE  *  CALFAN03 PROCONST. FOR/NOLI ST* 

C 

REAL  X <6)*T < 3*3) *Q (4) *  JET (4*12)* JETS EL (44*9) *RT*RVX 
REAL  W9(3)*MAXWX*MAXWY*MAXWZ* ALT* AB<3) * AR(3)*ANGC3) 

REAL  FUEL <3>*DELTAT*OVX*OVY#DVZ*OWX*DWY*DWZ* GAS  <3>*FX<6> 

REAL  D8X*D8Y*DBZ*SNAP(3)*REF(4)*DELT1*DELT2*INCLIN*TIME 
REAL  TH(3*3)*TARG(3)*AP(4)*RANGE*0MEGA*APST0P*0LDX(3) 

REAL  UP(3)*HAFWAY*RRATE*TFUEL*  FUDGE* STOP IT 
C 

INTEGERS  SYSSSETEF*SYSSWAITFR* CHAN* COUNT 
INTEGERS  I8UF(337)*I0SB<4) 

INTEGER  S(24)*C<12)*P(12)*I*J*PICK*L(24)*C0(12)*C0MM*LITE 
INTEGER  DC(12)*NL00PS*TABLE(4*12*9)*PC0UNT*APSW*RESET*FLAG 
INTEGER  PIC*DS(24)*DL(24)*0VHD(12)*I0STAT*TRKCNT*REST0P 
CHARACTER*^  TIM8UF 
INTEGER*4  TIMADR  'W 

C 

C  A8<3>  -  ACCELERATION  (BODY  FRAME) 

C  ALT  -  ALTITUDE  CF  TARGET  (KM) 

C  ANG ( 3)  -  ANGULAR  ACCELERATION  (BODY  FRAME) 

C  APSTOP  -  RANGE  FROM  TARGET  YOU  WISH  AUTOPILOT  TO  STOP 

C  APSW  -  AUTOPILOT  SWITCH  <S(3))  FROM  LAST  ITERATION 

C  AP<4)  -  UNIT  VECTOR  FROM  TARGET  TO  SHUTTLE  FOR  AUTOPILOT 

C  AR ( 3 )  -  ACCELERATION  (REF  FRAME) 

C  CHAN  -  CHANNEL  FOR  PHYSICAL  I/O  WITH  PS300 

C  COMM  -  1 =  RH C  IN  NEUTRAL*  0=RHC  NOT  IN  NEUTRAL 

C  COUNT  -  COUNTER  FOR  FAST  AUTOPILOT  GRAPHICS 

C  08X  -  X  DEADBAND  FOR  ATTITUDE  CONTROL 

C  DBY  -  Y  DEADBAND  FOR  ATTITUDE  CONTROL 

C  DBZ  -  Z  DEADBAND  FOR  ATTITUDE  CONTROL 

C  DELT1 *2  -  TIME  COUNTERS  TO  SEE  IF  LOOP  EXCEEDS  .04  SEC 

C  OELTAT  -  TIME  STEP 

C  DVX  -  X  VELOCITY  PULSE 

C  DVY  -  Y  VELOCITY  PULSE 

C  DVZ  -  Z  VELOCITY  PULSE 

C  DWX  -  X  ROTATIONAL  PULSE 

C  DWY  -  Y  ROTATIONAL  PULSE 

C  DWZ  -  Z  ROTATIONAL  PULSE 

C  FLAG  -  A  PARAMETER  TO  SLOW  DOWN  TRANSMISSION  RATE  TO  PS300 

C  FUDGE  -  FUDGE  FACTOR  TO  CHANGE  STS  RESPONSIVENESS 

C  FUEL<3)  -  TOTAL  FUEL  EXPENDED  FROM  EACH  TANK 

C  F  X (6)  -  PREDICTED  FUTURE  POS/VEL  OF  SHUTTLE 

C  G AS ( 3)  -  FUEL  CONSUMED  FOR  PRESENT  ITERATION  (FROM  EACH  T  \  ) 

C  HAFWAY  -  HALF  THE  DISTANCE  SINCE  LAST  AUTOPILOT  UPDATE 

C  (USED  FOR  BRAKING  PURPOSES) 
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XNCLXN  -  INCLINATION  OF  TARGET  ORBIT  (DEG) 

IBUF  -  BUFFER  FOR  ALL  MOVEMENT  (I/O  WITH  PS300) 

IOSB  *  UNKNOWN  PARAMETER  (?)  FOR  I/O  WITH  PS300 
IOSTAT  -  FLAG  FOR  CHECKING  I/O  ON  UNIT  20 
J  ET(4# 12 )  -  RESPONSE  TO  COMMANDS 

(ROW:  1-VERNIER  2-PRIMARY  3-LOW  Z  4-HIGH  Z> 

J  ETSEL(44#9)  -  PRECOMPUTED  ACCEL  AND  FUEL  FOR  EACH  THRUSTER 

LITE  -  1*LVLH+3  DISC  MODES  SELECTED#  0=N0T  SELECTED 

MAXWX  -  DISC  RATE  FOR  ROLL 

NAXWY  -  DISC  RATE  FOR  PITCH 

MAXWZ  -  DISC  RATE  FOR  YAW 

NLOOPS  -  LOOP  COUNTER 

OLDX (3)  -  ORIGINAL  SHUTTLE  POSITION  FROM  TARGET  IN  C-W  FRAME 
OMEGA  -  ANGULAR  RATE  OF  TARGET  ABOUT  EARTH  (RAD/SEC) 

P (1 2)-  PULSE  COMMAND  COUNTER 

PCOUNT  -  A  COUNTER  FOR  PRINT  STATEMENTS 

PIC  -  FLAG  FOR  PS300  GRAPHICS  USAGE 

PICK  -  NUMBER  Cr  SELECTED  RESPONSE  MATRIX  (JET) 

Q (4)  -  QUATERNION 

RANGE  -  RANGE  FROM  TARGET 

R  cF (4)  -  QUATERNION  (LVLH  TO  C-W  FRAME) 

RESET  -  COMMAND  FLAG  TO  START  OVER  FROM  ORIGINAL  POSITION 

RESTOP  -  COUNTER  TO  ALLOW  STOPPING  OF  PR06RAM  W/  RESET  BUTTON 

RRATE  -  RANGE  RATE  FROM  TARGET 

RT  -  RENDEZVOUS  TIME  FOR  BANANA  AUTOPILOT 

RVX  -  FINAL  RENDEZVOUS  OFFSET  DISTANCE  (35  FT) 

SNAPC3)  -  SNAPSHOT  ANGLE  (NEEDED  FOR  DISC  RATE  MODE) 

STOPIT  -  MAXIMUM  NUMBER  OF  MINUTES  YOU  ANTICIPATE  RUNNING 
T(3#  3)  -  TRANSITION  MATRIX  (BODY  TO  REFERENCE  FRAME) 
TABLE(4#12#9)  -  LIST  OF  THRUSTERS  FIRED  VS  COMMAND 
T ARG (3)  -  TARGET  POSITION  wRT  AFT  BAY  WINDOW 
TIHBUF#TIMADR  -  USEO  TO  SET  ITERATIVE  LOOP  TO  DELTAT 
TIME  -  TINE  (SEC) 

T FUEL  -  TOTAL  FUEL  USED 

TW(3#3)  -  TRANSITION  MATRIX  (REF  TO  WINDOW  FRAME) 

TRKCNT  -  COUNTER  FOR  WRITING  TO  UNIT  20 

UP(3)  -  UP  VECTOR  FOR  PS300  AND  ALIGNMENT  SUBROUTINE 

WB( 3)  -  ROTATION  RATE  (BODY  FRAME) 

X (6)  -  SHUTTLE  POSITION/VELOCITY  FROM  TARGET  IN  C-W  FRAME 

ASSIGNMENT  OF  DAP  PANEL  SWITCHES#  LIGHTS#  AND  THRUST  COMMANDS 

S(  )  -  SWITCH  ARRAY  (READ  FROM  DAP  PANEL) 

L (  )  -  LIGHT  ARRAY  (WRITTEN  TO  DAP  PANEL) 

C(  )  -  THRUST  COMMAND  ARRAY 

OVHD (  )  -  COMMAND  ARRAY  FOR  OVERHEAD  LOS  (READ  FROM  THC/RHC) 

C0(  )  -  COMMAND  ARRAY  FROM  LAST  ITERATION 
DC(  )  -  DUMMY  COMMAND  ARRAY 

S(1)  -  SELECT  A  /  PARAMETERS  FOR  FAR  AWAY  MANEUVERING  (MAN  MODE) 
/  DIRECT  AUTOPILOT  (AUTO  MODE) 

S  (2)  -  SELECT  B  /  PARAMETERS  FOR  CLOSE  IN  MANEUVERING  (MAN  MODE) 
/  C-W  (BANANA)  AUTOPILOT  (AUTO  MODE) 

S (3)  “  AUTOPILOT 
S (4)  -  MAN  /  MANUAL 
S (5)  -  NORM  RCS  JETS 
S (6)  -  VERNIER  RCS  JETS 
S (7)  -  DISCRETE  RATE  ROLL 
S (8)  -  DISCRETE  RATE  PITCH 
S  (9)  -  DISCRETE  RATE  YAW 
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$<1C>  -  ACCEL  ROLL 
S<11)  -  ACCEL  PITCH 
S (1 2)  -  ACCEL  YAW 
S(1 3)  -  PULSE  ROLL 
$(14)  -  PULSE  PITCH 
S05)  -  PULSE  YAW 
S(16)  -  LVLH 
S  07)  -  LOW  2  Y 
S <1 8)  -  HIGH  Z 
SOD  -  NORM  X 
S (20)  -  NORM  Y 
S (21 )  -  NORN  Z 
S  (22)  -  PULSE  X 
S (23 )  -  PULSE  Y 
S (24)  -  PULSE  Z 

L(  )  -  SAME  AS  S  ARRAY 

C(1) 

C  (2) 

C  (3) 

C  (4) 

C  (5) 

C  (6) 

C  (7) 

C  (8) 

C  (9) 

COO) 

C(11) 

C  (1  2  ) 

C0(  )  -  SAME  AS  C  ARRAY 
DC (  )  -  SAME  AS  C  ARRAY 

DON  0=  0  F  F 


-  *X 

-  -X 

-  *i 
- Y 

-  +1 
- Z 

-  *ROL 
- ROL 

-  ♦PCH 

-  -PCH 

-  *YAW 

-  -YAW 


INITIALIZATIONS 

DATA  TIM8UF/'OOQO  00:00:00.12*/ 

DATA  (S(I).I=1.24)/24*0/ 

DATA  (L( I). 1=1. 12) /I. 0.0. 1.1. 0.3*0. 3*1/ 
DATA  (L(I). 1=13. 24)/6*0. 3*1. 3*0/ 

DATA  (C(I).I=1.12)/1 2*0/ 

DATA  (C0(I). 1=1. 121/12*0/ 

DATA  (P(I).I=1.12)/1 2*0/ 

DATA  (X(I).I=1.6)/6*0/ 

DELT  AT  =  .04 
TIME*0. 

FLAG=0 

SET  TIMER 


CALL  $YSSBINTIM(TIM8UF.TIMADR> 

C 

C  READ  IN  JETSEL.  TABLE  AND  JET  MATRICES 

C 

OPEN (UN IT  =  2. NAMES’ t AL FANO. DATA} RESPONSES. DAT  * . 
♦  TYPE* ’OLD'. FORM* ‘UNFORMATTED '.READONLY) 

C 

DO  115  1=1.44 


READ (2) (JETSEL(I*J)*J*1*9> 

CONTINUE 

DO  120  1*1*12 

READ (2) (TA8LE(1*I*J)*J*1*9> 

RE AD (2) (TABL£(2*I*J)*J*1*9) 
READ(2)(TABLE(3*I*J)*J=1*9) 

RE AD (2) (TABLE(4*I*J)*J*1*9) 

READ (2) JET(1  #1) 

RE  AD ( 2) J E T ( 2* I ) 

READ(2) JET(3*I) 

R£AD(2)JET(4*I) 

CONTINUE 

CL0S£(2) 

ECOCHECK  DATA  THAT  WAS  READ  IN 
CALL  EC0CHK(TA9LE*JET> 

DETERMINE  USER  REQUIREMENTS 
PRINT  ***  DO  YOU  WISH  :* 

PRINT  *,*  1  -  REAL  TIME  6RAPHIC  SIMULATION* 

PRINT  *0*  2  -  FAST  GRAPHIC  AUTOPILOT  DEMO* 

PRINT  *0*  3  -  FAST  AUTOPILOT  W/0  GRAPHICS* 

READ  **PIC 

SET  UP  AUTOPILOT*  IF  CHOSEN 

IF  CCPIC  .EQ.  2). OR. (PIC  .EQ.  3>)  THEN 
Ld  )*0 
L<  2) *1 
L(3>*1 
L(4) *0 
APSW=1 
APSTOP*35 . 

ENDIF 

READ  IN  FUDGE  FACTOR 

PRINT  **  *  BY  WHAT  FACTOR  DO  YOU  WISH  TO  MULTIPLY* 
PRINT  ***  STS  RESPONSIVENESS  ?* 

READ  ** FUDGE 

APPLY  FUDGE  FACTOR  TO  THRUSTER  DATA 

DO  37  1*1*44 
00  38  J*1 *9 

iETSEL(I*J)*JETSEL(I*J)* FUDGE 
CONTINUE 
CONTINUE 

REAO  IN  MAX  RUN  TIME 

STOPIT«1000. 

IF  (PIC  .EQ.  1)  THEN 

PRINT  ***  HOW  LONG  DO  YOU  ANTICIPATE  RUNNING  ?* 
PRINT  **'  (IF  OVER  10  MINUTES  PLEASE  COORDINATE 
*  WITH  SEILER)* 
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READ  **  STOP  I T 
ENDI  F 
C 

C  READ  IK  TARGET  ALTITUDE 

C 

PRINT  ENTER  ALTITUDE  OF  TARGET  (KM)* 

READ  **  ALT 
C 

C  COMPUTE  ROTATION  RATE  OF  TARGET  ABOUT  EARTH 

C 

OMEGA*SQRT(  3986G0. 8/ ( ALT *637 8. 1 35 > ** 3 ) 

C 

C  READ  IN  INCLINATION  OF  TARGET  ORBIT 

C 

PRINT  *,*  ENTER  INCLINATION  OF  TARGET  ORBIT  (DEG)* 

READ  **INCLIN 
C 

C  READ  IN  INITIAL  SHUTTLE  POSITION 

C 

PRINT  *,*  ENTER  COORDINATES  OF  SHUTTLE  FROM  TARGET* 

PRINT  X,Y*Z  CLOHESSY'WILTSHIRE  FRAME  (FEET)* 

READ  *sOLDX(1)sCLDX(2)sOLOX(3) 

C 

C  ZERO  VELOCITY  AND  ANGULAR  MOTION  ARE  ASSUMED  FOR  SHUTTLE. 

C  SHUTTLE  ALIGNMENT  IS  INITIALIZED  SUCH  THAT  TARGET 

C  STARTS  IN  CENTER  OF  SCREEN  (“Z  IN  BODY  FRAME) 

C 

C  INITIALIZE  PS 300  DISPLAY 

C  INITIALIZE  BUFFER  FOR  PS300  MEMORY  ADDRESS 

C 

IF  (<PIC  .ED.  1). OR. (PIC  .EG.  2))  THEN 
CALL  PS300(ALT,INCLIN> 

CALL  INITBUF (IBUF#CHANsIOSB) 

ENDI  F 
C 

C  READ  AND  WRITE  TO  SHUTTLE  MOCXUP 

C 

IF  (PIC  .EQ.  1)  CALL  I0BUFF(1,S,L,0VHD*RESET) 

C 

C  OPEN  UNIT  20  FOR  WRITING  AND  SET  FORMAT. 

C  IF  UNABLE  r  PRINT  MESSAGE  AND  END  PROGRAM 

C 

OPEN(UNIT  =  20/’FILE=,ST$.TRK*,STATUS  =  'NEW*,IOSTAT  =  ISTAT) 

IF  (IOSTAT  .NE.  0)  THEN 

PRINT  **  *  CAN  NOT  OPEN  OUTPUT  FILE* 

PRINT  *✓ *  FILE  =  STS.TRK* 

PRINT  ISTAT  =  *  r 10  ST  AT 
GOTO  999 
ENDI  F 

4*4  F0RMAT('PV4(3X»F8.1)*4(3X*F8.6)) 

445  F0RMAT(*L'*4(3X*F8.1 )/4(3X,F8.6>) 

C 

C  SET  EVENT  FLAG  FOR  WAIT  COMMAND 

C 

CALL  SYSSSETEF(7) 

C 

C  RESET  BEGINS  HERE 

C 

135  CONTINUE 
C 


INITIALIZE  PARAMETERS 

SNAP (1 ) *0.0 
SNAPC2>*0.0 
SNAP (3) *0.0 
FUEL (1 ) *0.0 
FUEL (2) *0.0 
FUEL<3)*0.0 
WB(1 >*0.0 
WB(2)*0.0 
WB<3)*0.0 
FLAG*0 

UPC1 ) *0.0001 

UP<2)»1.0 

UP(3)»0.0001 

XC1 ) *0LDX <1 ) 

X<2)*0LDX(2> 

X(3)*OLOX<3> 

X{4) *0.0 
X(5)*0.0 
XC6>*0.0 
RES£T*0 

DO  175  1*1/12 
C<I)*0 

occi>*o 

CONTINUE 

HAFUAY*1 000 0000* 

WRITE  INITIAL  POSITION/  TINE/  AND  QUATERNION 
TO  UNIT  20 

WAITE<20/444)/X(1)/X<2>/X(3)/TIHE/Q<1>/Q(2)/Q(3>/Q<4> 

ALIEN  SHUTTLE  SO  TARGET  IS  CENTERED  IN  WINDOW 

CALL  ALIGN(X<1)/X<2)/X(3)/T/Q/UP) 

INITIALIZE  LVLH  REF  TO  ALIGNMENT  QUATERNION 

REF(1)*Q(1) 

REF<2>*Q(2> 

REF(3)*Q<3) 

REF(4)*Q(4) 

INITIALIZE  COUNTERS 

NLOOPS'O 

PC0UNT=999 

DELT1*SECNDS(0.) 

TRKC  NT*C 
COUNT*0 

ITERATIVE  LOOP  BEGINS  HERE 


CONTINUE 


UPDATE  COUNTERS 


NLOOPS=NLOOPS+1 
TIM£=NLOOPS*DELTAT 
PCOUNT=PCOUNT-M 
TRKCNT=TR<CNT+1 
COUN  T=COUNT41 
FLAG=FLAG+1 

C  PICK  APPROPRIATE  THRUST  RESPONSES. 

C  VALUES  OF  PICK  ARE  AS  FOLLOWS: 

C  1  -  VERNIER 

C  2  -  PRIMARY 

C  3  -  PRIMARY  WITH  *Z  INHIBITED 

C  4  -  PRIMARY  WITH  HIGH  l 

C 

C  CHOOSE  THRUST  RESPONSES  FROM  DAP  PANEL  LIGHTS 


IF 

( L ( 6 )  .EQ. 

1) 

P I C  K  =  1 

IF 

(L ( 5 )  .EQ. 

1) 

P I CK=2 

IF 

(L(1 7)  .EO. 

1) 

PI CK=3 

IF 

<  L  < 1 8)  .EQ. 

1) 

P I CK  =  4 

C  SELECT  RENDEZVOUS  CONSTRAINTS  (FROM  DAP  PANEL  LIGHTS) 

C 

IF  <<L<2)*L<3))  .GT.  0)  THEN 
DVX-. 01 
DVY=.  01 
DVZ=.01 
DWX=. 000175 
DUY=. 000175 
DWZ*. 000175 
D8  X  =  • 02 
D8  Y= . 02 
DB  Z= . 02 
HA  XWX  =. 06 
HAXWY=. 06 
HA  X WZ -. 06 

ELSE 

DV  X  =  . 05 
OVY=. 05 
OVZ= . 05 
DWX=. 000873 
DwY=. 000873 
DWZ=. 000873 
D9X=.  1 
09Y*.1 
D3Z  =  .  1 
MAXWX=. 3 
HAXVY=. 3 
MAXWZ=. 3 

END  I  F 
C 

C  CHECK  PULSE  MODE  LIGHTS 

C 

IF  ( L ( 2  2 )  .EQ.  1)  CALL  PUL  S  t  (  ?  ( 1 )*p(2)/C(1 )«C(2)rDVXs 

*  DELTAT*JET<PICK,1),DELTAT*JET(PICK,2)) 

IF  ( L  ( 2  3)  -ED.  1)  CALL  PULSE(P(3)*P(4)*C(3)*C(4)/'DVY* 

*  DELTAT*JET(PICK,3),DELTAT*JET(PICK,4>> 

IF  ( L ( 24)  .EQ.  1)  CALL  PUL S E ( P C 5 ) , P ( 6 ) , C ( 5 ) a C ( 6 ) , DV 1, 


*  DELTAT*JET(PICK,5),DELTAT* JET(PICK,6)) 

IF  (L(1 3)  .EB.  1)  CALL  PULSE (P C7) , P(8> # C (7) , C (8) /DWX, 

*  DELTAT*JET(PICKs7)sD£LTAT*JET(PICK,8>> 

XF  <L<U)  .EG.  1)  CALL  PULSE(P(9>*P{1Q)*C(9}*C(10)#DWY# 

*  DELTAT*JET(PICK,9),DELTAT*JET(PICK,10>> 

IF  (L(1 S)  .£0.  1)  CALL  PULSECP (11 > , P<1 2) ,C Cl 1 ) #C (1 2 ), DWZ, 

*  DELTAT*J£T(PICK,11),DELTAT*JET(PICK,12>> 

CHECK  LVLH  MODE  USING  COMM  AND  LITE 


C0HH*0 

LITE*0 

IF  ((C(7m(8)  +  C(9)+C(10>+C(11>*C(12>>  .EG. 
IF  (<L(16)+L(7)«L(8>*L(9)>  .EG.  4)  LITE=1 
IF  ( (LITE+COMW)  .EG.  2)  THEN 

CALL  LVLH(CsC0sGsREFsDBX/DSYsD3Zs 
-  W9sJETsDELTATsHAXWXsMAXWYrNAXWZ#PICKsT) 
ENDIF 


C0NH=1 


CHECK  DISC  NODE  LIGHTS 
IF  (L(1 6)  .EG.  0)  THEN 

IF  <LC7)  .EG.  1)  CALL  DISC (JET (PICK#7)*JET(PICK#8>*WB(1>* 
r  DELTATsMAXUX#C(7)sC(8)sC0<7)«C0(8)sDSXsSNAP(1>) 

IF  (L(B>  .EG.  1)  CALL  D I SC < J ET (PI CK, 9) #• J ET <P I CK,1 0) ,• WB ( 2) #• 
i  DELTAS HAXWY#C(9),C(10>*C0 (9), C0(1 0>,D6Y* SNAP (2>> 

IF  (L  (9)  .EG.  1)  CALL  DISC(JET(PICK*11>#JET(PICK*12)#HB(3)* 
-  DELTAT,MAXWZ,C(11>,C(12>*CO(11>,CO(12>*DBZ,SNAP(3>) 

ENDIF 

CHECK  IF  THE  AUTOPILOT  (A  OR  B)  IS  SELECTED 
A  -  DIRECT  APPROACH 
B  -  CLOSED  LOOP  CLOHESSY-WILTSHIRE 

IF  (L(3)  .EG.  1)  THEN 


ZERO  OUT 


COWHANDS 


C(1)*0 
C(2>*0 
C ( 3) *0 
C (4) *0 
C( 5)*0 
C(6)*0 

PREDICT  POS/VEL  PRODUCED  BY  RHC  COWHANDS  AND  DRIFT 

FX(1)«X(1) 

FX(2)»X(2) 

FX (3)*X(3) 

FX (4) *X (4) 

FX  (5)  *X  (5  ) 

FX (6)*X (6) 

CALL  THRUST(JETSEL'AS,ANGsGASrC'PICKsTA8L£) 

CALL  BTOR(T,AB*AR> 

CALL  LINTEG(FX,OHEGA,AR,DELTAT) 

CHOOSE  PROPER  AUTOPILOT 


**•  •  .  •  *  •  <"  »  ■  */. 


.  y 


I 


1 


IF  CL  <1 )  .EQ.  1)  THEN 

CALL  APILOT(L#C#REF#X#FX#T#APSW#  /-V- 

►  S(3)#AP#DELTAT#a#APST0P#JET#PICK) 

else  -S-' 

CALL  BANANA(FX#OMEGA#C#T#REF#L#  ^ 

►  S(3)#APSV#Q#HAFWAY#RT#D£LTAT#UP#JET#PICK#RVX) 

endif 

ENDIF 

IF  NO  OTHER  NODE  IS  CHOSEN#  NORM/ACCEL  MODE  IS  ASSUMED.  \\ 

COMMANOS  REMAIN  THE  SAME#  SO  NO  SUBROUTINE  IS  NEEDED.  ^ 

APPLY  COMMANDS  (C)  TO  RESPONSE  MATRIX  (JETSEL)  ■{ 

CALL  THRUST(JETSEL#AB#AN6#GAS#C#PICK#TABLE) 

TRANSLATE  800Y  ACCELERATIONS  (A8)  TO  REF  FRAME  CAR)  ^ 

CALL  BTOR(T#AB#AR)  ‘-'.7 

APPLY  ACCELERATIONS  TO  DETERMINE  POSITION  (XC1-3)) 

AND  VELOCITY  CXC4-6))  OF  SHUTTLE  RELATIVE  TO  TARGET 
USING  CLOHESSY-WILTSHIRE  EQUATIONS. 

CALL  LINTEG(X#CMEGA#AR#DELTAT) 

APPLY  ANGULAR  ACCELERATIONS  TO  FIGURE  QUATERNIONS  AND  NEW  T  MATT  V 


CALL  ROTATE(ANG#OELTAT#WB#Q#T) 
UPDATE  FUEL  USED 


4  i  ■  - » 


DO  900  1  =  1  #  3 

FUEL(I)=FUEL(I)*GAS(I)*DELTAT 

CONTINUE 

TFUEL=FUEL(1)+FUEL(2)+FUEL(3> 

DETERMINE  TARGET  POSITION  AND  ATTITUDE 
AS  SEEN  THRU  AFT  BAY  WINDOW. 

FOR  REAL  SIMULATION#  DISPLAY  ON  THE  PS300. 

IF  (PIC  .EQ.  1) 

►  CALL  LOOK<T#X#CMEGA#TIME#TFUEL#IBUF#CHAN#IOSB) 

IF  C(>IC  .EQ.  2). AND. (COUNT  .EQ.  13))  THEN 

CALL  L0OK(T#X#OM£GA#TIME#TFUEL#IBUF#CHAN#IOSB) 

COUNT=0 

ENDIF 

WRITE  POSITION#  TIME#  AND  ATTITUDE  DATA 
TO  UNIT  20  EVERY  10  SECONDS. 

IF  ( TRKCNT  .GE.  250)  tHEN 

NRITS(20#445)#X(1)#X(2)#X(3)#TIME#Q(1)#Q(2)#Q(3>#Q(4) 

TRKCNT=0 

ENDIF 

UPDATE  OLD  COMMAND  ARRAY  (CO) 

DO  950  1*1# 1 2 


.V  1  *•  -  *  ■ 


/  S; 


E-l  1 


•V 


CO(X)*DC(X) 

950  CONTINUE 
C 

C  UPDATE  AUTOPILOT  SWITCH 

C 

APSW«S(3) 

C 

C  PRINT  TO  SCREEN  EVERY  1000  ITERATIONS  IF  PIC  =  3 

C 

IF  ((PCOUNT  . 6E.  1000)  .AND.  (PIC  .EQ.  3) ) THEN 
PC0UNT«0 

PRINT  *#*  RANGE  (FT)  RAN6E  RATE  (FPS)** 

*  *  FUEL  USED  (L3S)  TINE  (SEC)* 

RANG£*SQRT(X(1)**2*X(2)**2+X(3)**2) 
RRATE»(X(1)*X(4>+X(2)*X(5)+X(3)*X<6) > /RANGE 
PRINT  **RAN€E*AAAT£*(FU£L(1)+FUEL(2)+FUEL(3))#TIME 

ENDIF 

C 

C  ZERO  OUT  SWITCHES  AND  RESTORE  THRUST  COMMANDS* 

C  SET  MANUAL  LIGHT  FLASHING  IF  AUTOPILOT  ON 

C 

DO  645  1*1*12 
S(I)*0 
S(I*12)*0 
C(X)*DC(I) 

645  CONTINUE 
C 

IF  ((L(3).EQ.1).AND.((TIME-INT(TIME)).GT..5)>  L(4)*1 
C 

C  READ  SWITCHES  AND  THRUST  COMMANDS  FROM  SHUTTLE  MOCKUP 

C  WRITE  TO  LIGHTS  ON  DAP  PANEL  OF  SHUTTLE  MOCKUP. 

C  IF  RESET  BUTTON  HELD  FOR  ONE  SECOND*  STOP  PROGRAM 

C  IF  RESET  COMMANDED#  GO  TO  135 

C 

IF  ((PIC  .EQ.  1). AND. (FLAG  .GE.  3))  THEN 
CALL  IOBUFF(2*S#L#OVHO*RESET) 

CALL  SYSSWAITFRC7) 

CALL  SVSSSETINR(7*TXMADR**) 

IF  (RESET  . E6.  1)  THEN 
RESTOP*RESTOP>1 
IF  (RESTOP  .EQ.  15)  GOTO  999 
GOTO  135 
ELSE 

RESTOP*Q 
ENDIF 
FL AG*0 
C 

C  CHANGE  INPUT  TO  REFLECT  OVERHEAD  LINE  OF  SIGHT 

C 

DC (1 )*0VHD(6) 

DC(2)*OVHO(5) 

DC (3) *0VHD ( 3) 

DC (4)*0VHD(4) 

DC(5)*0VHD(1) 

DC (6) *OVHD (2) 

DC (7) *OVHD (1 2) 

DC (8)*0VHD ( 11) 

DC (9) *OVHD (9) 

DC (1Q)*OVHD(10) 

DC (1 1 )*OVHO (7) 


DC  <1 2)*OVHO<8) 


C 

C  ASSIGN  REAL  COMMAND  ARRAY  (C>  WITH  DUMMY  COMMANDED  VALUES 

C  THIS  IS  TO  PRESERVE  DATA  READ  FROM  THC/RHC  WHILE  PROGRAM 

C  CHANGES  C  ARRAY  OUE  TO  VARIOUS  SELECTED  MODES 

C 

DO  475  1*1/12 
C(I)*DC (I) 

475  CONTINUE 

C 

ENDIF 

C 

C  IF  AUTOPILOT  ON/  SET  L<4)  (MANUAL  LIGHT)  TO  ZERO 

C 

IF  (L(3)  .EQ.  1)  L (4 ) *0 
C 

C  APPLY  SWITCH  COMMANDS  TO  DAP  PANEL  LIGHTS 

C 

CALL  SWITCH (S/L) 

C 

C 

C  RETURN  TO  450  FOR  NEXT  ITERATION 

C 

IF  (NLOOPS  .LT.  ( 1 500*STOPIT) )  GOTO  450 
C 

C  COMPUTE  AVERAGE  LOOP  TIME 

C 

DELT2*SECND  S (DELT1 ) 

PRINT  */'  AVERAGE  LOOP  TIME  =  '/DELT2/NL00PS/*  SECONDS* 

C 

C  CLOSE  UNIT  20 

C 

CLQSE(20) 

C 


CONTINUE 
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SUBROUTINE  ALI6N(X#Y#ZsTs9sUP) 

COMPUTES  BODY  AXIS  COMPONENTS  IN  REFERENCE  FRAME. 
ZBOD  IS  THE  POSITION  VECTOR.  XBOD  AND  YBOD 
COMPLETE  THE  RIGHT  HANDED  SYSTEM. 

DETERMINES  9UATERNION  (9)  AND  TRANSFORMATION 
MATRIX  CT). 

REAL  X#Y#Z#T(3#3)#9(4)#UP(3)#C0NST 
REAL  XBODC3>sY80D(3)sZBOD(3) 

CAMERA  VECTOR  BODY  COMPONENTS  (0#0#-1) 

ZBOD(1 )*X 
ZBOD(2)*Y 
ZBOD (3)*Z 

DO  NOT  ALLOH  ZBOD  TO  LIE  DIRECTLY  ON  AN  AXIS. 
THIS  IS  DONE  TO  PREVENT  9UATERNION  AMBIGUITIES. 

IF  (  ABS (ZBOD (1 ) )  .LT.  .001)  ZB0D(1)*.O01 
IF  (ABSCZB0DC2))  .LT.  .001)  ZBOD (2>». 001 
IF  (ABS(Z30D(3) )  .LT.  .001)  Z80D(3)*.001 

COMPUTE  TRANSFORMATION  MATRIX 

CALL  UNITIZEU30D) 

CALL  CROSS(Y30D#ZBOD#UP> 

CALL  UNIflZECYBOD) 

CALL  C ROS S ( XBOD# YBOD#Z BOD) 

CALL  UNITIZE (XBOD) 

UPC1 )*XB0D(1 ) 

UP(2)*XBOD(2) 

UP(3)*XBODC3> 


TC1#1) 
T(1#2) 
TCI#  3) 
T(2#1> 
T(2#  2) 
T(2#3) 
TC3#1) 
T(3#2) 
T(3#3> 


XBOD (1 ) 
'YBOO(I) 
ZBOD (1 ) 
XBOD (2) 
YB0DC2) 
ZBOD (2) 
XB0DC3) 
YB0DC3) 
ZBOD (3) 


COMPUTE  9UATERNZ0NS 

9(4>*1.0*T(1#im(2#2>*TC3#3) 

IF  (9(4)  .LT.  .IE-30)  9(4)*. IE-30 
9C4)*S9RT(9C4))/2.0 
9(1)*(T(3#2)-T(2#3))/(4. 0*9(4)) 
9(2)*(T(1#3)-T(3#1>)/(4. 0*0(4)) 
0(3)*(T(2#1)-T(1#2))/(4« 0*0(4)) 


NORMALIZE  9UATERNI0NS 

CONST*SORT(0(1)*0(1)*0(2)*0(2)*0<3)*0<3)+QC4)*0(4)) 
9(1)  *9  (D/CONST 
9(2) *0(2) /CONST 


SUBROUTINE  APILOTCL/Cs REF, X, FX,T,OLD SW/NEWSW, 
*  AP/DELTAT/Q, APSTOP, J  ET/PICK) 


C 

C  THIS  AUTOPILOT  FLIES  THE  SHUTTLE  DIRECTLY  TO 

C  TARGET  (DIRECT  APPROACH)  USIN6  LVLH  FOR  ATTITUDE 

C  CONTROL.  IT  *  THINKS*  ONE  ITERATION  IN  ADVANCE 

C  USING  PREDICTED  POS/VEL  DUE  TO  RHC  THRUSTING 
C  AND  ORBITAL  DRIFT. 

C 

REAL  R£F(4)/X(6)/NAXD,DELTAV(3) /VDB/DELTAT 
REAL  AP(4)/DP(3)/Q(4),APST0P/FX(6)/JET(4/12) 

REAL  DELV B(3) ,T( 3,3) /RANGE, REQV (3) 

INTEGER  L(24)/C(12)/I/ OLDS W/NEWSW, PICK 
C 

C  REF  -  REFERENCE  QUATERNION  FOR  ATTITUDE  CONTROL 

C  X  -  PRESENT  POS  AND  VEL  OF  SHUTTLE  FROM  TARGET 

C  FX  -  FUTURE  POS  AND  VEL  OF  SHUTTLE  FROM  TARGET 

C  MAXD  -  MAX  DISTANCE  CHANGE  FOR  ONE  ITERATION 

C  DELTAV  -  VELOCITY  CHANGE  (TARGET  FRAME) 

C  DELTAT  -  TIME  INCREMENT 

C  VDB  -  VELOCITY  DEADBAND 

C  AP  -  REFERENCE  UNIT  VECTOR  FROM  TARGET  TO  SHUTTLE 

C  DP  -  DESIRED  POSITION 

C  DELVB  -  VELOCITY  CHANGE  (BODY  FRAME) 

C  T  -  TRANSFORMATION  MATRIX 

C  L  -  DAP  PANEL  LIGHTS 

C  C  -  TMC/RHC  COMMANDS 

C  OLDSW  -  LAST  POSITION  OF  AUTOPILOT  SELECT  SWITCH 

C  NEWSW  -  PRESENT  POSITION  OF  AUTOPILOT  SELECT  SWITCH 

C  APSTOP  -  RANGE  YOU  WISH  TO  MAINTAIN  FROM  TARGET 

C  REQV  -  REQUIRED  VELOCITY 

C  Q  -  PRESENT  QUATERNION 

C 

C  COMPUTE  RANGE 

C 

RAN6E*SQRT(X(1)*X(1)+X(2)*X(2)*X(3)*X(3)) 

C 

C  INITIALIZE  LIGHTS  AND  COMMANDS 

C 

DO  100  1*1/1 2 
L(I)*0 
L(IM2)*0 
100  CONTINUE 
L(1) *1 
L(3) *1 
L(5) *1 
LC7) *1 
L(8)*1 
L(9)*1 
L(16)*1 
L(20)*1 
C 

C  COMPUTE  MAX  DISTANCE  CHANGE 

C 

MAXD*.00S*(RAN6E)*DELT AT 
IF  (RANGE  .LT.  1.5*APST0P)  THEN 

MAXD*MAXD*(RANG£”APST0P)/(.5*APST0P) 

ENDIF 

C 

C  SWITCH  TO  LOW  Z  INSIDE  200  FEET 


non  mono 
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C 

IF  (RANGE  . 6E.  200.0)  THEN 
L(21)«1 
ELSE 

L(17) *1 
ENOIF 
C 

C  CHECK  TO  SEE  IF  AUTOPILOT  JUST  SELECTED 

C 

IF  (OLDSW  ,NE.  NEWSW)  THEN 

SET  REF  TO  PRESENT  QUATERNION 
(TO  BE  USED  BY  LVLH) 

REF(l)aQd) 

REF(2)*Q(2> 

REF(3)*Q(3) 

REF(4)*Q(4) 

SET  REFERENCE  VECTOR 

AP(1)*X(1)/RANG£ 

AP (2)*X(2) /RANGE 
AP(3)=X(3)/RANGE 
AP(4)»RANG£*1«0 
C 

ENOIF 

C 

C  FI6URE  DESIRED  FUTURE  POSITION  (DP)  (*2  ITERATIONS) 

C 

IF  (ABS(RANGE-APSTOP)  .LT.  ABS(APU)-APSTOP))  then 
AP (4 ) =RANGE 
ELSE 

MAXD=0.0 

ENDIF 

C 

DP(1)*(AP(4)-2.0*NAXD)*AP(1) 

0P(2)»(AP(4)-2.0*MAXD>*AP(2) 

DP(3)*(AP(4)-2.0*NAXD)*AP(3) 

C 

C  COMPUTE  REQUIRED  VELOCITY  (NEXT  ITERATION) 

C 

REQV(1 )*<DP(1)«FX(1) )/DELTAT 
REQV(2)=(DP(2)-FX(2) )/DELTAT 
REQV(3)*(DP(3)-FX(3) )/DELTAT 
C 

C  FIGURE  VELOCITY  TO  8E  GAINED  ( DELTAV*  TARGET  FRAME) 

C 

DELTAV(1)*REQV(1)-FX(4) 

DELTAV(2)*REQV(2)-FX(5) 

0ELTAV(3)*REQV(3)-FX(6) 

C 

C  TRANSFORM  TO  BODY  FRAME 

C 

CALL  RT08(T,DELTAVsDELVB) 

C 

C  DETERMINE  IF  THRUST  IS  REQUIRED 

C  ( VD8  IS  VELOCITY  DEADBAND) 

C 


VD8*1 . 1 *DELT  AT 


IF  (DELV8(1 )  .  GT.  VDB* JETCPXCKsI )  >  C  <1  >»1 
IF  (DELVSd >  .LT.  VDB*JET(PICK/2) )  C<2>*1 
IF  <DELVB<2>  .ST.  VDB*JET<PXCK*3) )  C(3)*1 
IF  <DELV3<2>  .LT.  VDB*JET(PXCKs4> >  CU>»1 
IF  C DELVB(3)  .ST.  V0B*JET<PXCO5>  >  C<5)*1 
IF  CDELV9<3>  .LT.  VDB*JET(PXCK#6> )  C(6)*1 


SUBROUTINE  ARM 


THIS  ROUTINE  BUILOS  THE  PATLOAD  ARM  ON  THE  PS300 
ALL  DIMENSIONS  ARE  IN  FEET. 

INCLUDE  ‘PROCONST. FOR/NOLIST* 

REAL**  V( 3) 

COMMANDS  FOR  WRIST  ROLL 

SEND  LABEL  TO  DIAL  AND  CONNECT  TO  ROTATE  FUNCTION 

CALL  PFN< 1 WRROLL '*'YROTATE'#ERR) 

CALL  PSNSTC  *  WR  ROLL * #1 .  * OL ABEL 1 *, ERR > 

CALL  PCONNC* DIALS*  *1*1  /•'WRROLL**  ERR) 

CONNECT  INPUTS  TO  ACCUMULATOR 

CALL  PFNC'ACCI *** ACCUMULATE* *ERR> 

CALL  PCONN< 'WRROLL* * 1*1** ACC1* /ERR) 

CALL  PSNREACO.O*2**ACCl * *£RR) 

CALL  PSNREA(0.1*3**ACCl**ERR) 

CALL  PSNREAC1.0#4**ACCl**ERR> 

CALL  PSNREA(447.0*5**ACC1**ERR> 

CALL  PSNREA<-447.0/6**ACC1'#ERR) 

CONNECT  ACCUMULATOR  OUTPUT  TO  PROGRAM 

CALL  PCONN<,ACCl'^1»1#*WRIST.ROLL,»ERR) 


COMMANDS  FOR  WRIST  YAW 

SEND  LABEL  TO  DIAL  AND  CONNECT  TO  ROTATE  FUNCTION 

CALL  PFN(*WRYAW***  ZROTATE'*ERR) 

CALL  PSNSTC* WR  Y AW  *  *  1  *  * DL AB EL2 ' # E RR ) 

CALL  PCQNNC'DIALS**2/1**WRYAW* /ERR) 

CONNECT  INPUTS  TO  ACCUMULATOR 

CALL  PFNC* ACC2***  ACCUMULATE*  *ERR> 

CALL  PCONN(*WRYAW**1*1**ACC2'*ERR> 

CALL  PSNREA(O.Q*2**ACC2**ERR> 

CALL  PSNREA(0.1*3*'ACC2**ERR) 

CALL  PSNREA(1.C*4*'ACC2'*ERR> 

CALL  PSNREA(120.G*5**ACC2*»ERR) 

CALL  PSNREA<-120.0*6*’ ACC2**tRR> 

CONNECT  ACCUMULATOR  OUTPUT  TO  PROGRAM 

CALL  PCONNt'ACC2**1*1**yRIST.YAW,*ERR) 


COMMANDS  FOR  WRIST  PITCH 


E-  19 


C 

C  SEND  LABEL  TC  DIAL  AND  CONNECT  TO  ROTATE  FUNCTION 

C 

CALL  PFNC*WRPITCH*,*XROTATE*,ERR> 

c 

CALL  PSNSTC'WR  PITCH 1 ,* DLABEL3 * /ERR) 

CALL  PCONNC * DI ALS* #3,1 **WRPITCH*, ERR) 

C 

C  CONNECT  INPUTS  TO  ACCUMULATOR 

C 

CALL  PFNC  *ACC3*#* ACCUMULATE*  # ERR J 
C 

CALL  PCONNC •WAPITCH*#1#1#*ACC3'# ERR) 

CALL  PSNREAC0.0#2#*ACC3*#ERR) 

CALL  PSNREAC0.1#3#'ACC3*#ERR> 

CALL  PSNREAC1 .0#4**ACC3*#ERR) 

CALL  PSNREA  C120.0# 5#*ACC3*#ERR) 

CALL  PSNREAC-120.0,6#* ACC3*#ERR) 

C 

C  CONNECT  ACCUMULATOR  OUTPUT  TO  PROGRAM 

C 

CALL  PCONNC  *ACC3*#1#1#*WRIST«PITCH*,ERR) 

C 

C 

C  COMMANDS  FOR  ELBOW  PITCH 
C 

C  SEND  LABEL  TO  DIAL  AND  CONNECT  TO  ROTATE  FUNCTION 

C 

CALL  PFNC*ELPITCH*#*XROTATE*#ERR) 

C 

CALL  PSNST ( ' EL  PITCH* #1 #* DLABEL4* #ERR> 

CALL  PCONNC 'DIALS* *4*1 #*£LPITCH*#ERR> 

C 

C  CONNECT  INPUTS  TO  ACCUMULATOR 

C 

CALL  PFNC* ACC4*#* ACCUMULATE* #ERR) 

C 

CALL  PCONNC  *ELPITCH*#1/1#*ACC4*#£RR) 

CALL  PSNREAC0«0#2#  *  ACC4*  #  ERR) 

CALL  PSNREAC0.1#3#'ACC4*#ERR) 

CALL  P$NREAC1.0#4#'ACC4*#ERR) 

CALL  PSNREAC160.0,5#*ACC4*#ERR) 

CALL  PSNREAC~,2«0#6#*ACC4*#ERR> 

C 

C  CONNECT  ACCUMULATOR  OUTPUT  TO  PROGRAM 

C 

CALL  PCONNC * ACC4* » 1# 1# *  ELBOW. PITCH*, ERR) 

C 

C  COMMANOS  FOR  SHOULDER  YAW 
C 

C  SEND  LABEL  TO  DIAL  AND  CONNECT  TO  ROTATE  FUNCTION 

C 

CALL  PFNC*SHYAW*#*2ROTATE'#ERR) 

C 

CALL  PSNSTC  *  SH  YAW's1s*DLAGEL5*sERR) 

CALL  PCONNC* DIALS* #5,1 # * SHYAW * # ERR) 

C 

C  CONNECT  INPUTS  TO  ACCUMULATOR 

C 

CALL  PFNC *  ACC  5* #* ACCUMULATE*, ERR) 


CALL  PC0NNCSHYAW*,1,1,  *  ACC  5%  ERR) 

CALL  PSNREA(0.0,2,'ACC5*,ERR) 

CALL  PSNREA(0.1,3,*ACC5*,ERR) 

CALL  PSNREA<1.0,4,'ACC5',ERR) 

CALL  PSNREA(180.0,5»*ACC5*,ERR) 

CALL  PSNREA(-18C.0,6C  ACCS*,  ERR) 

CONNECT  AC  CUMUL AT  OR  OUTPUT  TO  PROGRAM 

CALL  PCONNC ACC  5*, 1,1, ' SHOULDER. YAW*, ERR) 

COMMANDS  FOR  SHOULDER  PITCH 

SEND  LABEL  TO  DIAL  AND  CONNECT  TO  ROTATE  FUNCTION 

CALL  PFN('SHPITCH*,*XROTATE* /ERR) 

CALL  PSNST C  $H  P I TCH * , 1 , * DLA BEL6 * , E R R) 

CALL  PC0NN('DIALS*,6,1,*SHPITCH',ERR) 

CONNECT  INPUTS  TO  ACCUMULATOR 

CALL  PFNC  ACC6*, 'ACCUMULATE* ,ERR) 

CALL  PCONNC  *  SHPITCH*,1,1,'ACC6*,ERR) 

CALL  PSNREA(0.0,2,*ACC6*,ERR) 

CALL  PSNREA(0.1,3,*ACC6*,ERR) 

CALL  PSNREA(1.0,4,*ACC6*,ERR) 

CALL  PSNREA(2.0,5,*ACC6*,ERRJ 
CALL  PSNR£A(-145.0,6,*ACC6',ERR> 

CONNECT  ACCUMULATOR  OUTPUT  TO  PROGRAM 

CALL  PCONNC * ACC6* ,1 ,1,* SHOULDER. PITCH *  , ERR) 

CREATE  A  3D  VECTOR  (IN  FEET)  TO  TRANSLATE  ARM 

CALL  PFNCXYVEC*,*VEC',ERR) 

CALL  PFNC*XYZVEC*,*VEC*,ERR> 

CALL  PCONNC  XYVEC  *,1,1,*  XYZVEC*,  ERR) 

CALL  PCONNC  XYZVEC', 1,1,*  SHOULDER.  TRAN*  ,  ERR) 


BUILD  A  WRIST 

CALL  PBEGSCWRIST*,  ERR) 

CALL  PROTXCPITCH'  ,0.0, *’"  ,ERR) 
V<1 )=.54l 5 
V<2>  = 1.23 
V<3)=.5415 

CALL  PSC  ALEC"*,  VC  CYLINDER*,  ERR) 
V<1)=0.0 
V<  2)-1 . 23 
V( 3 ) =0. 0 

CALL  PTRANSC"*,V,  ERR) 

CALL  PR0TZ('YAU',0.0,'*,*,ERR) 

CALL  PROTYC  ROLL*, 0.0, , ERR) 

V(1  )=.54l5 
V<2)=4.93 


VC3)*.5415 

CALL  PSC ALE C*/V/' CYLINDER'/ ERR) 

CALL  PENDSCERR) 

C 

C  BUILD  A  FOREARM  CM/  ELBOW) 

C 

CALL  PB£GSC*£LBOW'/ERR) 

VCD*0.0 
VC2)*0.0 
VC3)*.541 5 

CALL  PTRANSC*"'/V/***'/ERR) 

CALL  PROTXC'PITCH'/0.0/'"'/ERR> 

VCD*0.0 

VC2)*0.0 

VC3)*-.5415 

CALL  PTRANSC'**'/V/"’*/ERR> 

VC1 )*. 541 5 
VC2)*23.1625 
VC3)*.541 5 

CALL  P$CALEC""/V/*CYLINDER*/ERR) 

VCD*0.0 

VC2)*23.1625 

VC3)«0.0 

CALL  PTRANSC*’*'/V/'WRIST*/ERR) 

CALL  PENDS(ERR) 

C 

C  BUILD  THE  SHOULDER 
C 

CALL  PBEGSC '  SHOULDER* / ERR) 

VC1)*0.0 
V(2)*0.0 
VC  3)*0.  0 

CALL  PTRANSC'TRAN*/V/*"'/ERR> 

CALL  PR0TZC""/9G.0/'CYL'/ERR> 

VC1)*. 58 
V(2)*1 . 083 
VC3)*. 58 

CALL  PSCALEC'CYL'/V/' CYLINDER '/ERR) 

CALL  PROTXC'H'/90.0/'**'/ERR) 

CALL  PROTXC'PITCH* /O.G/*"*/ERR) 

CALL  PROTZC*YAW'/a.O/""/ERR) 

VCD*.  5415 
V ( 2 )*20. 921 
VC3)*.5415 

CALL  PSC ALE C'"'/V/ 'CYLINDER* /ERR) 

VC1 )*0. c 

VC2)*20.921 

VC3)*0.0 

CALL  PTRANSC*" */V/*EL80W'/ERR) 

CALL  PENDSCERR) 

C 

C  RESCALE  SHOULDER  FROM  FEET  TO  KM  AND  NAME  IT  'ARM* 
C 

VCD*. 0003048 
VC2)*. 0003048 
VC3>». 0003048 

CALL  PSCALEC' ARM'/ V/' SHOULDER* /ERR) 


SUBROUTINE  9ANANA(X*0MEGA*C/T*REF*L* 
*NEWSW*OLDSW*Q,HAFWAY*RT*D£LTAT*UP*JET,PICK*RVX) 


THIS  IS  AN  EXPLICIT  GUIDANCE  SCHEME. 

IT  SOLVES  THE  CLOHESSY-WILTSHIRE  EQUATIONS  FOR 
VELOCITY  REQUIRED  (VX*VY*VZ/  TARGET  FRAME)  GIVEN 
A  SPECIFIED  RENDEZVOUS  TIME  (RT).  VELOCITY  TO 
BE  GAINED  (DELTAV)  IS  THE ^  COMPUTED  AND  TRANSFORMED 
TO  BODY  FRAME  (DcLV9).  IF  OUTSIDE  THE  VELOCITY 
DEADBAND  (VDB)*  THRUST  IS  COMMANDED. 

LVLH  IS  USED  TO  MAINTAIN  ATTITUDE  WITH  REPEATED 
CALLS  TO  •ALIGN". 


X(6)*OMEGA*REF(4)*DUMT(3/3)*VX*VY 
T(3*3)#DELTAV(3)*DCLV6(3)*A*D*E*F 
RANGERS**  VZ*Q(4i *H A F WA Y* RT * D ELT AT * UP ( 3 ) 
P0S(3)*9PCS(3)*JET(4*12)*RVX 


INTEGER  C(12)*I/L(24)*NEWSU*CLDSV*PICK 


L  -  DAP  PANEL  LIGHTS 

T  -  TRANSFORMATION  MATRIX 

DUMT  -  DUMMY  TRANSFORMATION  MATRIX 

REF  -  REFERENCE  QUATERNION  FOR  LVLH  MODE 

OMEGA  -  ROTATION  RATE  OF  TARGET  ABOUT  EARTH 

C  -  COMMAND  SWITCHES 

DELTAV  -  VEL  CHANGE  (TARGET  FRAME) 

DELVB  -  VEL  CHANGE  (80D  FRAME) 

RANGE  -  RANGE  FROM  TARGET 
RT  -  RENDEZVOUS  TIME  (SECONDS) 

AsBsOsE*  F  -  INTERMEDIATE  VARIABLES 

VX*VY*VZ  -  VELOCITY  NEEDED 

NEWSU  -  PRESENT  CONDITION  OF  S(3) 

OLDSW  -  LAST  CONDITION  OF  S ( 3 ) 

HAFWAY  -  HALF  DISTANCE  TO  TARGET 
X  (6)  -  FUTURE  PREDICTED  POS/VEL 
DELTAT  -  TIME  INCREMENT 
UP  -  UP  VECTOR  (FOR  ALIGNMENT) 

JET  -  ACCELERATION  AVAILABLE  (F/S**2> 

PICK  -  THRUST  PROFILE  SELECTED 

RVX  -  FINAL  RENDEZVOUS  OFFSET  DISTANCE 


V.  j/-  ^ _ 


INITIALIZATIONS 


RANGE*SQRT(X(1)*X(1)+X(2)*X(2)*X(3)*X(3>) 


DO  100  1=1*12 
L(I)=0 
L( 1+1 2) =0 
CONTINUE 


SET  DAP  PANEL  LIGHTS 


L ( 2) =1 
L( 3) *1 
L(5) =1 
L ( 7) =1 
L  (  3) =1 
L (9) =1 
L  ( 1 6 )  =  1 


LC20)»1 


USE  LOW  Z  FROM  60-200  FEET 

IF  ({RANGE. LE. 200.0). AND. (RANGE. GE. 60. )>  THEN 
L(17)at 
ELSE 
L(21)*1 
ENDIF 

UPDATE  TIME  TO  RENDEZVOUS 
RT*RT-DELTAT 

CHECK  TO  SEE  IF  AUTOPILOT  JUST  SELECTED 

IF  (OLDSW  .NE.  NEWSW )  THEN 
HA FWAY*10 00000. 

RVX*0. 

ENDIF 

CHECK  TO  SEE  IF  YOU  ARE  'HALFWAY*  THERE 
(ACTUALLY  4/5  OF  THE  WAY  THERE) 

IF  (RANGE  .LT.  HAFWAY)  THEN 
RT»4.*RANGE 

IF  (RT  .GT.  1200.)  RT*1 200. 

IF  (RAN6E  .GE.  250.)  THEN 
HAFWAY*25Q. 

ELSE 

HAF WAY*( RANGE-35.) /5. *3 5. 

ENDIF 

IF  (X(1 )  .LT.  O.C)  THEN 
RVX»*35 . 

ELSE 

RVX*-35. 

ENDIF 

ENDIF 

IF  (RT  .LT.  0.0)  RT*100. 

COMPUTE  NEW  REFERENCE  QUATERNION  BASED  ON  POSITION 

CALL  ALIGN(X(1)»X(2)sX(3)sDUMT'REF»UP) 

CHANGE  X (1 )  TO  PISS  HITTIN6  TARGET  BY 
RVX  OISANCE  FEET 

X(1 ) *X (1 ) ♦RVX 

COMPUTE  DELTAV  (TARGET  FRAME) 

SW*SIN(OMEGA*RT) 

CW*COS(OM£GA*RT) 

A*-3.0*RT+4.0*SW/OPEGA 
8*(2.0/0M6GA)*(CW-1 .0) 
F*X(1)-6.0*0MEGA*X(2)*RT*6.0*X(2)*SW 
D*SW/OMEG A 

E»4.0*X(2)-3.0*X(2)*CW 


VX=(“B*VY-F)/A 

VZ*-X(3)*0MESA*CW/SW 


DELTAV(1)*VX-X<4> 

DELTAV(2)*VY-X(5) 

DELTAV(3)=VZ-X<6> 

TRANSFORM  TO  BODY  FRAME 


CALL  RTO0 (T/ 

DELTAV 

/DELVB) 

DETERMINE 

IF  THRUST  IS  REQUIRED 

VDB  IS  VELOCITY 

DEADBAND 

VDB 

*1 . 1 *DELT  AT 

IF 

( DELV9 (1 > 

.GT. 

VD 9* J  £T (P I CK/ 1 >  > 

C (1 )*1 

IF 

( DEL V8 (1 ) 

•  LT. 

VDB*JET(PICK/2)) 

C (2)=1 

IF 

( DELV9 (2) 

.GT. 

VDB*JET(PICK/3)) 

C ( 3) ST 

IF 

( DEL VB ( 2 ) 

.LT. 

VDB*JET(PICK,4>) 

C(4)*1 

IF 

(DELV9C3) 

.GT. 

VDB*JET (PICK/ 5) > 

C (5>*1 

IF 

( DELV8 ( 3 ) 

.LT. 

V0B*J£T(PICK/6)) 

C(6)=1 

SUBROUTINE  BTOR (T/BOD, REF > 

TRANSFORMS  FROM  BOD  TO  REF  FRAME  GIVEN  TRANSFORMATION  MATRIX  T 
REAL  T(3*3)#BOD(3)sREF(3) 

REF<1)*80D<1>*T(1,1>*80D<2>*TC1,2>*B0DC3>*T(1,3> 

REF(2)«B0D(1 ) *T(2#1)+BOD(2)*T(2#2)+BOD(3)*T(2s3) 
R£F<3>»BOD<1>*T<3*1>*BOD<2>*T(3,2>*BOD<3>*T(3,3> 


SUBROUTINE  CHECK (ANG /D8/WB/C 1/C2/JET1/J ET2/MAX/DEL TAT) 


THIS  SUBROUTINE  EXAMINES  ANGLE  (ANG)  AND  BODY  RATE  (MB) 

TO  DETERMINE  THRUST  REQUIRED  TO  RESTORE  ANGLE  WITHIN 
DEADBAND  (DS)  WHILE  NOT  EXCEEDING  MAX  BODY  RATE  (MAX) 

A  WINDOW  IS  SET  UP  (S A)  TO  STOP  ROTATION.  IF  INSIDE  WINDOW 
AND  APPROACHING  ZERO/  THRUST  TO  STOP. 

REAL  AN6/DB/WB/JET1/JET2/ MAX/D  EL TAT/SA 
INTEGER  C1/C2/N 

DELTA!  -  TIME  INCREMENT 

SA  -  STOP  ANGLE  (ANGLE  REQUIRED  TO  MAKE  W3*0> 

N  -  COUNTER  FOR  STOP  ANGLE  SOLUTION 
JET  -  ANGULAR  ACCELERATION  AVAILABLE 

INITIALIZATIONS 

C1*0 

C2=0 

CHECK  IF  OUTSIDE  DEADBAND 
IF  ( A8S (ANG )  .GT.  03)  THEN 

CHECK  IF  UB  IS  GOING  AWAY  FROM  SNAPSHOT  AND  CHOOSE  THRUST 

IF  (ANG*W8  .GE.  0.0)  THEN 
IF  (ANG  .GT.  0.0)  C2  =  1 

IF  (ANG  .LT.  0.0)  C1=1  / 

ELSE 

ELSE  W9  IS  MOVING  TOWARDS  SNAPSHOT.  DETERMINE  STOP 
ANGLE  (SA)  AND  CHOOSE  THRUST. 

IF  (ANG  .GT.  0.0)  THEN 

SA=ABS(.5*WB*WB/ JET1)+DB*.9 
N=INT(-W8/(JET2*DELTAT) ) 

SA*ABS (N*WB+JET2*DELTAT*N*(N-1 ) /2 . 0) *D ELT AT* .9*DB 
IF  (ANG  .LE.  SA)  Cl =1 

SA*A8S(.5*(W8+JET2*DELTAT)**2/JET1) 

SA=SA+.9*D8*W8*DELTAT 
IF  (ANG  .GT.  SA)  C2-1 
ELSE 

SA*ABS(.5*WB*WB/ JET2)+D3*.9 
N=INT(-W3/(JET1 * DEL TAT) ) 

SA=ABS(N*WB*4ET1*DELTAT*N*(N-1)/2.0)*DELTAT*.9*DB 
IF  (ABS(ANG)  .LE.  SA)  C2  =  1 
SA*AB$(.5*(WB*JET1*DELTAT)**2/JET2) 

SA=SA+.9*D3*WB*DELTAT 
IF  (ABS (ANG)  .GT.  SA)  C1=l 
END  I F 
ENDIF 
ENDIF 

COMPARE  RATES  TO  MAX  RATE  AND  SET  THRUST  COMMANDS 

IF  (WB  .GT.  0.0)  THEN 

IF  ((WB+DELTAT*JET1)  .GT.  MAX)  C1=0 
IF  (WB  .GT.  MAX)  C 2  =  T 
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SUBROUTINE  DISC ( J ET1 * J ET2* V8#DELTAT, MAX.C1  ,C2*C01  *C02*D9* ANG) 

C 

C  ATTITUDE  CONTROL  SCHEME  FOR  ONE  BODY  AXIS.  ALSO 

C  APPLIES  DISCRETE  RATE  (MAX)  TO  PRESENT  BODY  RATE  (WB). 

C  IP  DISC  RATE  WILL  BE  (OR  IS  BEING)  EXCEEDED*  COMMAND  (C1*C2> 

C  IS  SET  TO  BRIN6/MAINTAIN  RATE  WITHIN  LIMITS. 

C 

REAL  JET1 *JET2*DELTAT*MAX*W8*T/DB*SA*ANG 
INTE6ER  Ct#C2?C01*C02 
C 

C  ANG  -  ANGLE  PROM  WHEN  SNAPSHOT  TAKEN 

C  SNAP  -  TRIGGER  TO  TAKE  NEW  SNAPSHOT 

C  COl«2  -  OLD  COMMAND  PROM  RHC 

C  Cl *2  -  PRESENT  COMMAND  PROM  RHC 

C  DB  -  DEADBAND  WIDTH  (♦/-) 

C  JET1*2  -  ANGULAR  ACCELERATION  AVAILABLE 

C  N8  *  BODY  RATE  (POR  SELECTED  AXIS) 

C 

C  COMPUTE  PRESENT  ANGLE  FROM  SNAPSHOT  ANGLE 

C 

ANG«ANG+W8*DELTAT 

C 

C  TAKE  SNAPSHOT  (SNAP*1)  IP  CONTROLLER  HAS  JUST  BEEN  MOVED  TO  NEUTRAL 

C 

SNAP*0 

IP  ( (C1+C2)  .EG.  0)  THEN 

IF  ((C01-C1)  .GT.  0)  SNAP*1 
IP  ((C02-C2)  .GT.  0)  SNAP»1 
IF  (SNAP  .EG.  1)  ANG«0.0 
C 

C  DETERMINE  THRUST  PROFILE 

C 

CALL  CHECK(ANG*D8#WB*C1*C2*JET1*JET2* 

*  MAXsDELTAT) 

C 

ELSE 

C 

C  COMPARE  RATES  TO  MAX  RATE  AND  SET  THRUST  COMMANDS 

C 

IF  (WB  .GT.  0.0)  THEN 

IP  ((WB*DELTAT*JET1)  .GT.  MAX)  C1=0 
IP  (WB  ,6T.  MAX)  C 2*1 
ELSE 

IP  ((WB+DELTAT*JET2)  .LT.  -MAX)  C2*0 
IP  (WB  .LT.  -MAX)  Cl *1 
ENDIP 
ENDIF 
END 


E-30 


SUBROUTINE  ECOCHK(TABLE/ JET) 

C 

C  ECOCHECK  OF  TABLE  AND  JET 

C 

REAL  JET(4/12) 

INTEGER  I/J/TABLE(4/12/9> 

C 

175  FORMAT(1X/A5/3X/9(1X/I2)/5X/F8.5) 

C 

PRINT  */ (CHAR (027) /CHAR(072> /CHAR (027)/ CHAR ( 074) ) 

PRINT  */'  ECOCHECK  OF  VERNIER  THRUSTER  TABLE  AND  ACCEL* 
PRINT  */'  * 

PRINT  175/'  ♦  X*/(TABL£<1/1/J>/J*1/9)/J€T<1/1) 

PRINT  175/*  -  X*/(TABLE(1/2/J)/J*1/9)/JET(1/2) 

PRINT  175/*  ♦  T*/(TABLE(1/3/J)/J=1/9)/JET(1/3) 

PRINT  */*  * 

PRINT  175/*  -  Y*/(TABL£(1/4/J)/J*1/9)/JET(1/4) 

PRINT  175/'  ♦  Z'/(TABLE(1/5/J)/J*1/9)/JET(1/5) 

PRINT  175/*  -  Z'/(TABLE(1/6/J)/Jx1/9)/JET(1/6) 

PRINT  */*  * 

PRINT  175/**  R0L*/(TABLE(1/7/J)/J-1/9)/JET(1/7) 

PRINT  175/*-  RCL*  /  (TABLEd /8/J  )/ J»1 /9)/JET(1/8) 

PRINT  1 75/ ' ♦  PCH*/(TABL£(1/9/J)/J*1/9)/JET(1/9) 

PRINT  */*  * 

PRINT  175/'-  PCH'/(TABL£(1/10/J)/J=1/9)/JET(1/10) 

PRINT  1 75/ ' ♦  YAW,/(TABL£(1/11/J)/J=1/9)/JET(1/11) 

PRINT  175/'-  YAW'/(TABL£(1/12/J)/Jx1/9)/JET(1/12) 

PRINT  *#'  ' 

PRINT  */*  HIT  RETURN  TO  CONTINUE* 

RE  AO  * 

C 

PRINT  */( CHAR (027) /CHAR (072) /CHAR (027) / CHAR (074) ) 

PRINT  */'  ECOCHECK  OF  PRIMARY  THRUSTER  TABLE  AND  ACCEL* 
PRINT  */'  * 

PRINT  175/'  ♦  X'/(TABLE(2/1/J)/J*1/9)/JET(2/1) 

PRINT  175/*  -  X*/(TABLE(2/2/J)/J=1/9)/JET(2/2) 

PRINT  175/*  ♦  Y'/(TABLE(2/3/J)/Jx1/9)/JET(2/3) 

PRINT  */'  ' 

PRINT  175/'  -  Y*/(TABLE(2/4/J>/J=1/°)/JET(2/4) 

PRINT  175/'  ♦  Z'/(TABLE(2/5/J > / J *1 / 9 ) / JET C 2/ 5 ) 

PRINT  175/*  -  Z*/(TABL£(2/6/J)/Js1/9)/JET(2/6) 

PRINT  */'  ' 

PRINT  175/**  R0L'/(TABLE(2/7/J)/J=1/9)/JET(2/7) 

PRINT  175/'-  RCL*/(TABLE(2*8/J)/J=1/9)/JET(2/8) 

PRINT  175/'+  PCH*/(TABLE(2/9/J)/J=1/9)/JET(2/9) 

PRINT  */'  * 

PRINT  175/'-  PCH*/(TABLE(2/10/ J)/J=1 /9)/JET(2/10) 

PRINT  1 75/ ' ♦  YAW'/(TABLE(2/1 1/J)/J*1/9)/JET(2/11) 

PRINT  175/'-  YAW'/(TABLE(2/12/J)/J=1/9)/JET(2/12) 

PRINT  */'  ' 

PRINT  */'  HIT  RETURN  TO  CONTINUE' 

REAO  * 

C 

PRINT  */( CHAR ( 027) /CHAR( 072) /CHAR (027) /CHAR (074) ) 

PRINT  */'  ECOCHECK  OF  PZI  THRUSTER  TABLE  AND  ACCEL' 
PRINT  */'  * 

PRINT  175/'  ♦  X'/(TABLEC3/1/J)/J=1/9)/JET(3/1) 

PRINT  175/'  -  X*/(TABLE(3/2/J)/J=1/9)/JET(3/2) 

PRINT  175/'  ♦  Y'/(TA8LE(3/3/J)/J=1/9)/JET(3/3) 

PRINT  */'  ' 
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PRINT  1 75/*  -  Y'#(TA8LE(5#4sJ)sJ*1#9)#jET(3s4) 

PRINT  175#*  ♦  Z*#(TABLE(3#5#J)#J«1#9>#JET(3#5> 

PRINT  175#*  -  Z '#  (T ABLE(3#6#J )# J*1 #9) # JET (3#6) 

PRINT  «#•  • 

PRINT  175#*9  ROL*  # (T A8LE(3#7#J)#J*1#9) #JET<3#7> 

PRINT  175#*-  RCL'#(TABLE(3#8/J>#J«1s9)#JET(3s8> 

PRINT  175#**  PCH*  # (TABLE (3#  9# J  J#J=1#9)#JET(3#9) 

PRINT  *#•  • 

PRINT  175#*-  PCM*#(TA8L£(3/10#J)#JS1#9)#JFT(3#10) 
PRINT  175#' ♦  YAU*#(TABLE(3#11#J>#J«1#9>#JET(3#11) 
PRINT  175#*-  YAM*  # (T ABLE( 3# 1 2#  J) #  J«1 #9)#JET(3#12> 
PRINT  *#•  • 

PRINT  *#*  HIT  RETURN  TO  CONTINUE* 

READ  * 

C 

PRINT  *#(eHAR(027>#CHAR(072>#CHAR(02?>#CHARC074>> 
PRINT  *#•  ECOCHECK  OF  PZHI  THRUSTER  TABLE  AND  ACCEL* 
PRINT  *#*  * 

PRINT  175#*  ♦  X  *# (TABLE (4#1#J)#J*1#9)#JET(4#1) 

PRINT  175#*  -  X *# (TABLE (4#2#J)#J*1#9)#JET(4#2) 

PRINT  175#'  ♦  Y*#(TABLE(4#3#J>#J*1#9)#JETC4#3> 

PRINT  *#*  * 

PRINT  175#'  -  Y * # (TABLE (4#4#J>#J*1#9)#JET(4#4) 

PRINT  175#'  ♦  2  *# (TABLE (4#  5 #4 )#J*1#9)#JET(4#5> 

PRINT  175#*  -  Z*  # (TABLE(4#6# J )# J  s1#9) # JET (4# 6) 

PRINT  *#•  * 

PRINT  175#*+  ROL*  # (TABLE (4#7#J ) #J=1#9)#JET(4#7> 

PRINT  175#*-  RCL*#(TA8LE(4#8#J)sJ  =  ‘i'9>#JET(4#8> 

PRINT  175#**  PCN'#(TABLE(4#9#J)#J*1#9)#JET(4#9> 

PRINT  *#•  * 

PRINT  175#*-  PCM*#(TABL£(4#10#J>#J*1#9)#JET(4#10) 
PRINT  1 75#  * ♦  VAN*  # (T  ABLE (4# 1 1#J)#JX1/9)#4ET(4#11) 
PRINT  175#*-  YAN* # (T ABLE (4# 1 2# J) #Ja1#9)#JET(4#12) 
PRINT  «*#*  * 

PRINT  *#*  MIT  RETURN  TO  CONTINUE* 

READ  « 

C 

PRINT  *#(CMAR(027)#CHAR(072»#CHAR(027)#CHAR(074>) 


C 


END 


THE  FOLLOWING  ERROR  HANDLER  DEMONSTRATES  THE  GENERAL 
OVERALL  RECOMMENDED  FORM  THAT  THE  USER'S  OWN  ERROR 
HANDLER  SHOULD  FOLLOW. 

THIS  ERROR  HANDLER  UPON  BEING  INVOKED  WRITES  ALL 
MESSAGES  TO  THE  DATA  FILE:  *  PROERROR.LOG* .  ERROR 
AND  WARNING  EXPLANATION  MESSAGES  ARE  ARE  WRITTEN  TO 
A  DATA  FILE  FOR  2  REASONS: 


1. 


THE  ERROR  HANDLER  SHOULD 
WRITE  INFORMATION  OUT  ON 
SINCE  THE  EXPLANATORY  TE 
OR  WARNING  CONDITION  MAY 
THE  PS  300  AND  THEREFORE 
DISPLAYED  ON  THE  PS  300 
CASE  OF  A  CATASTROPHIC  D 
ERROR). 


NOT  IMMEDIATELY 
THE  PS  300  SCREEN 
XT  DEFINING  THE  ERROR 
BE  TAKEN  AS  DATA  BY 
WIND  UP  NOT  BEING 
SCREEN  (AS  IN  THE 
ATA  TRANSMISSION 


2. 


THE  LOGGING  OF 
LOGFILE  ALLOWS 
TO  BE  REVIEWED 


ERRORS  AND  WARNINGS  TO  A 
ANY  ERRORS  AND/OR  WARNINGS 
AT  A  LATER  TIME. 


SUBROUTINE  ERR  <  ERRCOD  ) 

PROCEDURAL  INTERFACE  ERROR  HANDLER: 


INCLUDE  ' 

PROCONST. FOR/NOLIST* 

INTEGERS 

ERRCOD 

INTEGER** 

PSVMSERR 

LOGICAL 

FILCPN 

DATA 

FILOPN  /.FALSE./ 

EXTERNAL 

PSVMSERR,  DETERM,  PIDCOD 

If  (FILOPN) 

GOTO  1 

OPEN  ERROR  FILE  FOR  LOGGING  OF  ERRORS: 


OPEN  (U.NIT  =  10,  FILE='PROERPOR.LOG',  STATUS= '  NEW* , 

S  DISP='KEEP',  ORGANI 2ATI0N=' SEQUENTIAL' , 

i  ACCESS='SEQUENTIAL*,  C ARRIAGECONTRCL='LIST' ) 


F I LOP  N  =  . 
ENO  IF 

1  CALL  PIDCOD 
IF  (ERRCOD  . 
WRITE  (10, 

& 

& 


TRUE. 

(ERRCOD) 

LT.  512)  GOTO  3 

*)  'PS-I-ATDCOMLNK:  ATTEMPTING  TO  ' 

//  'DETACH  PS  300/H0ST  COMMUNICATIONS  * 
//  'LINK.' 


WHEN  WE  ATTEMPT  TO  PERFORM  THE  DETACH,  USE  A 


DIFFERENT  ERROR  HANDLER  SO  AS  NOT  TO  GET  CAUGHT 
IN  A  RECURSIVE  LOOP  IF  WE  CONSISTENTLY  GET  AN 
ERROR  WHEN  ATTEMPTING  TO  DETACH. 

CALL  PDTACH  CDETERH) 

CLOSE  (UNIT*10) 

IF  (CERRCOD  .LT.  PSFPAF)  .OR. 

&  (ERRCOD  .GT.  PSFPPF))  GOTO  2 

IDENTIFY  VMS  ERROR  IF  THERE  WAS  ONE 

CALL  LI8SST0P  (XVAL  (PSVMSERR  <))) 

GOTO  3 
ELSE 

2  STOP 
END  IF 

END  IF 

3  RETURN 
END 


SUBROUTINE  OETERH  (ERRCOD) 


MAIN  ERROR  HANDLER  DETACH  ERROR  HANDLER: 


INTE6ER**  ERRCOD 
EXTERNAL  PIOCOD 

WRITE  (10,  *)  'PS-I-ERRWARDET:  ERROR/WARNING  * 
ft  //  'TRYING  TO  DETACH  * 

ft  //  'THE  COMMUNICATIONS' 

WRITE  (10,  *)  'LINK  BETWEEN  THE  PS  300  AND  THE  HOST. 
CALL  PIDCOD  (ERRCOD) 

RETURN 

END 


SUBROUTINE  PIDCOD  (ERRCOO) 


PIDCOD!  IDENTIFY  PROCEDURAL  INTERFACE  COMPLETION 
CODE. 


INCLUDE  ' PROCONST. FOR/NOLIST' 

INTEGER**  ERRCOD 
CHARACTER  VH$DEF*133,  PIDEF*133 
INTEGER**  PSVMSERR 
CHARACTER  MSSG1*55,  MSSG2*67 

PARAMETER  (MSSG1  =  'PS-W-UNRCOMCOD:  PROCEDURAL  * 
ft  //  'INTERFACE  ' 

ft  //  '(GSR)  COMPLETION  *) 

EXTERNAL  PSVMSERR 


WRITE  (10,  *)  'PS-I-PROERRWAR:  PROCEDURAL  ' 
l  //  'INTERFACE  WARNING/' 


iv.  vviv  <.■  v  >:.■  «■  m.«  kH'-j  v.'  •  yn  *■-',«" 
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c 


c 


c 


c 


c 


c 


g 


WRITE  (10, 
IF  ( ERRCOD 


//  'ERROR  COMPLETION 
*>  'RECEIVED.* 

•NE.  PSWSNC)  GOTO  1 


CODE  WAS 


WRITE  (10, 

*> 

•PS-W-BADNAMCHR: 

SAD  CHARACTER  * 

g 

H 

•IN  NAME  WAS  * 

g 

// 

•TRANSLATED  TO:  " 

*•  t 
• 

GOTO  1000 

ELSE 

1  IF  (ERRCOD  . 

NE. 

PSWNTL)  GOTO  2 

WRITE  (10, 

*) 

•PS-W-NAMTOOLON: 

NAME  TOO  ’ 

g 

// 

•LONG.  NAME  WAS  ' 

g 

// 

•TRUNCATED  TO  ' 

WRITE  <10, 

*> 

•256  CHARACTERS.' 

GOTO  1000 

ELSE 

2  IF  (ERRCOD  . 

9 

UJ 
7. r 

PSWSTL)  GOTO  7 

WRITE  <10, 

o 

•PS-W-STRTOOLON: 

STRING  TOO  # 

g 

// 

'LONG.  STRING  ' 

g 

// 

'WAS  TRUNCATED  * 

WRITE  <10, 

*> 

'TC  240  CHARACTERS 

• 

■ 

GOTO  1000 

ELSE 

7  IF  (ERRCOD  . 

NE. 

PSWAAD)  GOTO  8 

WRITE  <10, 

*) 

•PS-W-ATTALRDON: 

ATTACH  * 

g 

// 

•already  done.  • 

g 

// 

•MULTIPLE  CALL  TO 

PATTCH  WITHOUT* 

WRITE  <10, 

*> 

•INTERVENING  PDTACH  CALL  IGNORED.* 

GOTO  1000 

ELSE 

8  IF  (ERRCOD  . 

NE. 

PSUAKS )  GOTO  9 

WRITE  <10, 

*> 

•PS-W-ATNKEYSEE: 

ATTENTION  KEY  * 

g 

// 

•SEEN  (DEPRESSED). 

f 

CALL  PIBMSP 

g 


GOTO  1000 
ELSE 

IF  (ERRCOD  , 
WRITE  (10, 

WRITE  (1C, 


NE. 

*> 

// 

*> 

// 

*> 


WRITE  (10 
CALL  PIBMSP 
GOTO  1000 
ELSE 

10  IF  (ERRCOD  .NE. 
WRITE  (10,  *) 
g  // 

g  // 


PSW3GC)  GOTO  10 
•PS-W-BADGENCMR:  BAD  GENERIC 

•CHANNEL  CHARACTER.  BAD  ’ 
'CHARACTER  IN  STRING  SENT  VIA: 
'PPUTGX  WAS  TRANSLATED  TO  * 

•A  BLANK.  ' 


PSW8SC)  GOTO  11 
'P3-W-0ADSTRCHR:  BAD  ’ 

'CHARACTER  IN  STRING  WAS 
'TRANSLATED  TO  A  BLANK.' 


CALL  PIBMSP 
GOTO  1000 
ELSE 

11  IF  (ERRCOD  .NE. 
WRITE  (10,  *> 

a  // 

a  // 

WRITE  (10,  *) 
S  // 

CALL  PIBMSP 
GOTO  1000 
ELSE 


PSW3PC)  GOTO  12 

’PS-W-SADPARCHR:  BAD  PARSER  ' 

•CHANNEL  CHARACTER.  BAD  • 
'CHARACTER  IN  STRING  SENT  TO' 
'PS  300  PARSER  VIA:  PPUTP  ' 
'WAS  TRANSLATED  TO  A  BLANK.' 


£*,  »r  *s  **  4»*fc  A^vU^fc 


rr^r 
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C 


c 


c 


c 


c 


c 


c 


c 


12  IF  ( ERRCOD  .NE.  PSEIMC)  GOTO  13 

WRITE  <10#  *>  ’PS-E-INVMUXCHA:  INVALID  * 
&  //  • MULTIPLEXING  CHANNEL  * 

ft  //  ’SPECIFIED  IN  CALL  TO:' 


WRITE  <10# 

*> 

’PMUXCI#  PMUXP#  OR  PMUXG.’ 

GOTO  1000 

ELSE 

13  IF  (ERRCOD  . 

NE. 

PSEIVC)  GOTO  14 

WRITE  <10# 

O 

•PS-E-INVVECCLA:  INVALID  ’ 

ft 

// 

•VECTOR  LIST  CLASS  ' 

ft 

// 

•SPECIFIED’ 

WRITE  <10# 

*> 

•IN  CALL  TO:  PVCBEG.* 

GOTO  1000 

ELSE 

14  IF  (ERRCOD  . 

NE. 

PSEIVD)  GOTO  15 

WRITE  <10# 

*> 

•PS-E-INVVECDIM:  INVALID  • 

ft 

// 

•VECTOR  LIST  DIMENSION  * 

ft 

// 

•SPECIFIED  IN  CALL  TO* 

WRITE  <10# 

O 

•PVCBEG.’ 

GOTO  1000 

ELSE 

IS  IF  (ERRCOD  . 

NE. 

PSEPOE)  GOTO  16 

WRITE  <10# 

*) 

•PS-E-PREOPEEXP:  PREFIX  • 

ft 

// 

•OPERATOR  CALL  WAS  ’ 

ft 

// 

•EXPECTED.* 

GOTO  1000 

ELSE 

16  IF  (ERRCOD  . 

NE. 

PSEFOE)  GOTO  17 

WRITE  <10# 

O 

•PS-E-FOLOPEEXP:  FOLLOW  * 

ft 

// 

•OPERATOR  CALL  WAS  * 

ft 

// 

•EXPECTED.* 

GOTO  1000 

ELSE 

17  IF  (ERRCOD  . 

NE. 

PSELBE)  GOTO  18 

WRITE  <10# 

O 

•PS-E-LABBLKEXP:  CALL  TO  • 

ft 

// 

'PLAADD  OR  PLAEND  WAS  ' 

ft 

// 

•EXPECTED.' 

GOTO  1000 

ELSE 

18  IF  (ERRCOD  . 

NE. 

PSEVLE)  GOTO  19 

WRITE  <10# 

*> 

•PS-E-VECLISEXP:  CALL  TO  * 

ft 

// 

'PVCLIS  OR  PVC END  ' 

ft 

// 

•WAS  EXPECTED.* 

6OT0  1000 

ELSE 

19  IF  (ERRCOD  .NE.  PSEAMV)  GOTO  20 

WRITE  <10#  *>  ’PS-E-ATTMULVEC:  ATTEMPTED 

ft  //  ’MULTIPLE  CALL  ’ 

ft  U  'SEQUENCE  TO  PVCLIS  IS  NOT* 

WRITE  <10#  O  ’PERMITTED  FOR  BLOCK  ' 

ft  //  'NORMALIZED  VECTORS.’ 

60T0  1000 
ELSE 

20  IF  (ERRCOD  .NE.  PSEMLB)  GOTO  21 

WRITE  <10#  *>  'PS-E-MISLA8BEG:  MISSING  ' 


ft  //  'LABEL  BLOCK  BEGIN  CALL.  ’ 

ft  //  'CALL  TO  PLAADD  OR  PLAEND* 


WRITE  <10#  O  ’WITHOUT  CALL  TO:  PLABEG.’ 
GOTO  100C 


% 

& 


^  J  1 V  ,- 


■  r:  tr.  wj  irj  ifj  v»;  t; 


E-  36 


>r. 


21  I F  (ERRCOD  .NE. 
WRITE  (10#  *> 
8  U 

&  // 

*> 
// 


WRITE  (10# 


GOTO  1000 
ELSE 

22  IF  (ERRCOD  .NE. 

WRITE  (10#  *) 
8  // 
GOTO  1000 
ELSE 

23  IF  (ERRCOD  .NE. 

WRITE  (10#  *> 
&  // 
&  // 
WRITE  (10#  *) 
GOTO  1000 
ELSE 

24  IF  (ERRCOD  .NE. 

WRITE  (10#  *> 
&  // 
8  // 
WRITE  (10#  *> 


PSEMVB)  GOTO  22 
•PS-E-MISVECBEG:  MISSING 

•VECTOR  LIST  BEGIN  * 
•CALL.  CALL  TO  PVCLIS* 
•OR  PVCEND  WITHOUT  CALL  * 
•TO:  PVCBEG.' 


PSENUN)  GOTO  23 
' PS-E-NULNAM:  NULL  NAME  * 

'PARAMETER  IS  NOT  ALLOWED.* 


PSEBCT)  GOTO  24 
• PS-E-BADCOMTTP:  BAD  * 

•COMPARISON  TYPE  OPERATOR  ' 
•SPECIFIED  IN  * 

•CALL  TO:  PIFLEV.’ 


PSEIFN)  GOTO  25 
•PS-E-INVFUNNAM:  INVALID 

•FUNCTION  NAME.  • 
•ATTEMPTED  PS  300* 
•FUNCTION  INSTANCE  FAILED 


X 


» 

8 

// 

•BECAUSE  THE  NAMED  * 

*.• 

8 

// 

•FUNCTION  CANNOT  POSSIBLY* 

‘v  V 

WRITE  (10#  *) 

•EXIST.  THE  FUNCTION  NAME  • 

L.’ 

8 

// 

•IDENTIFYING  THE  * 

» 

8 

// 

•FUNCTION  TYPE  TO  INSTANCE* 

9 

WRITE  (10#  *) 

•WAS  LONGER  THAN  256  CHARACTERS.* 

*. .  _ 

GOTO  100C 

k  • 

c 

ELSE 

’*>■>. 

\* 

25  IF 

(ERRCOD  .NE. 

PSENNR)  GOTO  26 

V/’v 

s’ 

WRITE  (1C#  O 

' PS-E-NULNAMREQ:  NULL  NAME  * 

8 

// 

•PARAMETER  IS  ' 

•y-y- 

1 

8 

// 

•REQUIRED  IN  OPERATE  NODE* 

WRITE  (1C#  *) 

•CALL  FOLLOWING  A  PPREF  OR  • 

k.  r 

8 

// 

•PFOLL  PROCEDURE  CALL.’ 

,  .*,v. 

GOTO  1000 

V 

c 

ELSE 

26  IF 

(ERRCOD  .NE. 

PSETME)  GOTO  27 

i 

WRITE  (10#  *> 

’ PS-E-TOOMANEND:  TOO  ' 

* 

p 

8 

// 

’MANY  END_STRUCTURE  CALLS  • 

..  .. . 

[■; 

8 

// 

•  INVOKED. * 

z 

GOTO  1000 

c 

ELSE 

* 

27  IF 

(ERRCOD  -NE. 

PSENOA)  GOTO  28 

y 

WRITE  (10#  *) 

•PS-E-NOTATT:  THE  PS  300  * 

R 

r. 

8 

// 

•COMMUNICATIONS  LINK  * 

«..  .  * 

8 

// 

'HAS  NOT  * 

/, 

WRITE  (10#  *) 

•YET  BEEN  ESTABLISHED.  * 

.*  *.■  * 

8 

// 

•PATTCH  HAS  NOT  BEEN  * 

8 

/  / 

•CALLED  OR  FAILED.’ 

-v\* 

y 

GOTO  1000 

■ 

r 

c 

ELSE 

28  IF 

(ERRCOD  .NE. 

PSEODR)  GOTO  29 

WRITE  (10#  *> 

'  P3-E-0VEDURREA:  AN  ' 

•• 

8 

// 

•OVERRUN  OCCURRED  DURING  * 

* 

8 

/  / 

•A  READ  OPERATION.’ 

t*  «• 


WRITE 

(10#  *> 

•THE 

SPECIFIED 

INPUT  BUFFER 

ft 

// 

•IN 

CALL  TO: 

PGET  * 

ft 

// 

•OR: 

PGETW* 

WRITE 

(10#  *) 

•WAS 

TOO  SPALL 

AND  * 

ft 

// 

•TRUNCATION  HAS  OCCURRED.' 

60T0 

1000 

29 

38 


t 

t 


39 


t 

& 


40 


t 

ft 


ELSE 

IF  (ERRCOD  .NE. 
IF  ( ERRCOD  .HE. 
WRITE  (10#  *) 
// 
// 

WRITE  (10#  *> 
CALL  PVAXSP 
GOTO  1000 
ELSE 

IF  (ERRCOD  .NE. 
WRITE  (10#  *> 
// 
// 

WRITE  (10#  O 
CALL  PVAXSP 
GOTO  1000 
ELSE 

IF  (ERRCOD  .NE. 
WRITE  (10#  O 
// 
// 

WRITE  (10#  *> 
CALL  PVAXSP 
GOTO  1000 
ELSE 

IF  (ERRCOD  .NE. 
WRITE  (10#  *> 
ft  // 

ft  // 

GOTO  1000 
ELSE 

42  IF  (ERRCOD  .NE. 

WRITE  (10#  *) 
ft  // 

ft  U 

GOTO  1000 
ELSE 

43  IF  (ERRCOD  .NE. 

WRITE  (10#  *) 
ft  // 

GOTO  1000 
ELSE 

44  IF  (ERRCOD  .NE. 

WRITE  (10#  *> 
ft  // 

GOTO  1000 
ELSE 

45  IF  (ERRCOD  .NE. 

WRITE  (10#  *) 

ft 
ft 

WRITE  (10# 


41 


PREICP)  GOTO  38 
PSEPDT)  GOTO  39 
•PS-E-PHYDEVTYP:  PISSING  * 

•OR  INVALID  PHYSICAL  * 
•DEVICE  TYPE* 

•SPECIFIER  IN  CALL  TO  PATTCM 


PSELDN)  GOTO  40 
•PS-E-LOGDEVNAP:  PISSING  * 

•OR  INVALID  LOGICAL  * 

•DEVICE  NAPE* 

•SPECIFIER  IN  CALL  TO  PATTCH 


PSEADE)  GOTO  41 
•PS-E-ATTDELEXP: 
•PARAMETER  STRING 
•DELIMITER* 

%mlm  WAS  EXPECTED. 


ATTACH 


PSFPAF )  GOTO  42 
•PS-F-PHYATTFAI:  * 

•PHYSICAL  ATTACH  OPERATION  • 
•FAILED.' 


PSFPDF)  GOTO  43 
•PS-F-PHYOETf AI: 
•DETACH  OPERATION 
•FAILED. ' 


PHYSICAL 

* 


PSFPGF)  GOTO  44 
•PS-F-PHYGETFAI:  PHYSICAL 

'GET  OPERATION  FAILED.' 


PSFPPF)  GOTO  45 
•PS-F-PHYPUTFAI:  PHYSICAL 

•PUT  OPERATION  FAILED.' 


// 

i! 

*> 

// 


PSFBTL)  GOTO  46 
•PS-F-3UFT0CLAR:  BUFFER  ' 

'TOO  LARGE  ERROR  IN  ' 

•CALL  TO:  PSPUT.' 

•THIS  ERROR  SHOULD  NEVER  * 
•OCCUR  AND  INDICATES  A  * 


ft 


ft 


//  'PROCEDURAL  INTERFACE  (GSR)' 


WRITE 

<10,  *> 

•INTERNAL  VALIDITY  CHECK.' 

CALL 

PVAXSP 

GOTO 

1000 

ELSE 

46  IF  (ERR 

COD  .NE. 

PSFWNA)  GOTO  47 

WRITE 

<10,  *> 

•PS-F-WRONUMARG:  WRONG  * 

ft 

// 

•NUMBER  OF  ARGUMENTS  ' 

a 

// 

'IN  CALL  TO  PROCEDURAL* 

WRITE 

(1C,  *> 

•INTERFACE  (GSR)  LOW-LEVEL  ' 

& 

// 

•I/O  PROCEDURE  ' 

8 

// 

'(SOURCE  FILE:  PROIOLIB.MAR 

WRITE 

<10,  *> 

'THIS  ERROR  SHOULD  NEVER  ' 

ft 

// 

•OCCUR  AND  INDICATES  A  ' 

& 

// 

•PROCEDURAL  INTERFACE  (GSR)* 

WRITE 

<10,  *> 

•INTERNAL  VALIDITY  CHECK.* 

CALL 

PVAXSP 

GOTO 

1000 

ELSE 

47  IF  (ERR 

COD  .NE. 

PSFPTL)  GOTO  48 

WRITE 

(1C,  O 

• PS-F-PROTOOLAR:  PROMPT  * 

ft 

// 

•BUFFER  TOO  LARGE  * 

ft 

// 

•ERROR  IN  CALL  TO:  PSPRCV.* 

WRITE 

<10,  *> 

•THIS  ERROR  SHOULD  NEVER  • 

ft 

// 

•OCCUR  AND  INDICATES  A  * 

ft 

// 

•PROCEDURAL  INTERFACE  (GSR)' 

WRITE 

<10,  *> 

•INTERNAL  VALIDITY  CHECK.' 

CALL 

PVAXSP 

GOTO 

1000 

ELSE 

UNKNOWN  ERROR  MESSAGE  ERROR  MESSAGE. 

48  IF  ( ERRCOD  .GE.  512)  GOTO  49 

MSSG2  =  MSSG1  //  'WARNING' 

GOTO  51 
ELSE 

49  IF  (ERRCOD  .GE.  1024)  GOTO  50 

MSSG2  =  MSSG1  //  'ERROR  ' 

GOTO  51 


ELSE 


50 

MSS 

G2  = 

M 

SS31  // 

•  F 

ATAL 

ERROR  ' 

EN 

D  I 

F 

END 

IF 

51 

WRITE  ( 

10, 

*) 

MSSG2 

WRIT 

E  < 

10, 

*> 

*  CODE 

IS 

UNREC 

OGN 

I Z  ED. * 

WRIT 

E  < 

10, 

*> 

' PROBA 

8LE 

PROC 

EDU 

RAL  * 

ft 

// 

•  INTER 

FAC 

E  (GS 

R) 

INTERNAL 

ft 

// 

' VALID 

ITY 

CHEC 

K  E 

RROR.  ' 

END 

IF 

1000 

IF  < 

<ER 

RCOD 

m 

LT.  PSF 

PAF 

)  .OR 

• 

ft 

(ER 

RCOD 

m 

GT.  PSF 

PPF 

)>  GOTO 

2000 

CALL  PSFVMSERR  <  VMSDEF,  PIDEF  ) 

WRITE  (10,  *)  'DEC  VAX/VMS  ERROR  ' 

&  //  'DEFINITION  IS:’ 

WRITE  <10,  *>  VMSDEF 

WRITE  <10,  *)  'PROCEDURAL  INTERFACE  ' 

//  '(GSR)  INTERPRETATION  OF  ' 

//  'DEC  VAX/VMS  COMPLETION  CODE: 
WRITE  <10,  *)  RIDEF 


& 

& 


WRITE  (10#  *)  *  DEC  VAX/ VMS  ERROR  CODE  * 

&  //  'VALUE  WAS:  '#  PSVMSERR  (> 

END  IF 

2000  WRITE  (10#  *> 

RETURN 

END 


SUBROUTINE  PIBMSP 


PI8MSP!  WRITE  THE  "IBM  VERSION  SPECIFIC- 
MESSAGE  TO  THE  ERROS  HANDLER  FILE, 


WRITE 

(10# 

*) 

'THIS  ERROR/WARNING 

IS  ' 

» 

// 

•applicable 

ONLY  TO 

THE  IBM  ' 

K 

// 

'VERSION  OF 

THE' 

WRITE 

(10# 

*) 

'PROCEDURAL 

INTERFACE  (GSR).* 

RETURN 

END 


SUBROUTINE  PVAXSP 


PVAXSP:  WRITE  THE  "DEC  VAX/VMS  VERSION 

SPECIFIC"  MESSAGE  TO  THE  ERROR 
HANDLER  FILE. 


WRITE  (10#  *)  'THIS  ERROR/WARNING  IS  ' 

&  //  'APPLICABLE  ONLY  TO  THE  DEC  ' 

&  //  ' VAX/ VMS  VERSION  OF' 

WRITE  (10#  O  'THE  PROCEDURAL  INTERFACE  (GSR) 
RETURN 


SUBROUTINE  INITBUF(I8UF/CHAN/I0SB) 

THIS  SUBROUTINE  FILLS  I3UF  WITH  DATA  THAT  DOES  NOT  CHAN6E  % 
DURING  PROGRAM.  THIS  DATA  IS  USED  TO  ADDRESS  PS300  MEMORY  > 
LOCATIONS. 

INTEGER*4  SYSSQIO/ SYSSSETEF/SYSSWAITFR 
INTEGER*4  CHAN/STATUS/ SYS$ASSIGN/SYSSQI0W/NAMADX<20> 
INTEGER*2  I8UfC3  ' > / N AME S ( 5/ 20 >/ NAMADR (2/20) / I OSB <4> /BUFNUM 
CHARACTERS  UNIT 
EQUIVALENCE  (NAMAOR/NAMADX) 

DATA  NAME$/*TA'/'RG'/'T .  '  / 'LO'/'OK'/'XY'/'ZV'/'C.'^LO'/'OK* 
1  'GL'/'OB'/'E.'/'LO'/'OK'/'ST'/'AR'/'S.'/'LO'/'OK* 

1  'GL'/'OB'/'E.'/'TR'/'OT'/'ST'/'AR'/'S.'/'TR'/'OT* 

1  'GL'/'OB'/'E.'/'ER'/'OT'/'SA'/'TE'/’L.'/'RO'/'TX* 

1  *XY*/*PT'/'H.'/*TR*/'N1*/'XY'/'PT'/'rt.#/*TR*/*N2* 

1  'XY'/'PT'/'H.'/'TR'/'NS'/'XY'/'PT'/'H.'/'TR'/'NA* 

1  'XT*/ 'PT'/'H.'/'TR'/'N5'/ 

1  'IN'/'FO'/'.RS'AN'/'GE'/'INS'FO’/'.R'/'RA'/'TI' 

1  'IN'/'FO'/'.R'/'FU'/'EL'/'IN'/'FO'/'.R'/'TI'/'ME' 

1  'XY'/'PT'/'H.'/'SS'/'TR'/'XY'/'PT'/'H.'/'RO'/'TZ* 

1  'XY'/'PT'/'H.'/'RO'/'TX*/ 

DATA  UNIT/'PIAO* / 

WAIT 

DO  5  J  =  1/ 100000 
CONTINUE 

SET  UP  HOUSEKEEPING 

GET  A  CHANNEL  NUMBER 

STATUS=SYSSASSIGN<UNIT/CHAN//> 

IF(STATUS.NE.I)  THEN 

TYPE  */ ' BAD  ASSIGN!  <STATUS>  =  '/STATUS 
STOP 
ENDIF 

DETACH  FOR  SAFETY:  34  — >  DETACH  FUNCTION  CODE 

STATUS=SYSSQI0W(/XVAL(CHAN)/XVAl<34)/I0SB////////) 

ATTACH:  33  — >  ATTACH  FUNCTION  CODE 

STATUS=SYSS<aiOW</XVAL<CH  AN)/ XVALC  33) /I0S8/ ///////) 

IF (ST  ATUS.NE. 1 )  THEN 

TYPE  */ ' B AD  ATTACH!  <STATUS>  =  '/STATUS 
STOP 
ENDIF 

GET  THE  ADDRESSES  OF  THE  ENTITIES  TO  UPDATE 
43  — >  LOOKUP  NAMED  ENTITIES  FUNCTION  CODE 

DO  25  1*1/20 

STATUS=SYSSQIOW(/XVAL(CHAN)/%VAL(43)/IOSB///NAMESC1/I)/ 

1  XVAL(10)/%VAL(1 >///) 

IFCSTATUS.EQ.1 .AND. I0SBC1 ) .EQ.1 .AND. 


E-4  1 


CX0SB(3).0R.I0S8<4)).NE.0)  SOTO  21 
TYPE  • BAD  ENTITY  FETCH!  <STAT*IOSB>  —  *  ^STATUS# I0S8 
STOP 


SET  THE  AODRESS  FROM  OUT  OF  THE  10  STATUS  BLOCK  CIOSB) 

DO  24  J*1/2 

NANADR(Jsl)*I0SB(J+2) 

CONTINUE 

CONTINUE 


OFFSET  THE  ADDRESSES  TO  GET  PAST  THE  FIRST  THREE  FIELDS 
OF  THE  NODE  WHICH  WE  DO  NOT  WANT  TO  CHANGE. 

DO  30  1*1 #20 

NANADX(X)*NANADX(I)+8 

CONTINUE 

OFFSET  TEXT  BY  AN  ADDITIONAL  16 


DO  31  I*14#17 

NANADX<I)*NANADX(I)-M6 

CONTINUE 


BUFFER  1  SETUP 
TRANSLATION  NEEDS  7  ELEMENTS 
ROTATION  NEEDS  19  ELENENTS 
LOCKAT  NEEDS  28  ELENENTS 


IBUFC1) 
IBUFC2) 
IBUF ( 3) 
IBUFC4) 
IBUF 1 24) 
IBUF (32) 
IBUFC33) 
IBUF  C  34 ) 
IBUF (54) 
IBUFC62) 
IBUF ( 63) 
IBUF(64) 
IBUFC84) 
IBUF (92) 
IBUFC93) 
IBUF (94) 
IBUF(114> 

IBUF (122) 
IBUF ( 123) 
IBUF (124) 
IBUF (144) 
IBUF  < 1 45) 
IBUF  < 146) 


20 

NANADR (1 / 1 ) 
NANAD  RC2s1 ) 
27 
1 

NANADR (1*2) 
NANADR (2s2 ) 
27 
1 

NANADR (1 *3) 
NANADR (2*3) 
27 
1 

NANADR ( 1 *4 ) 
NANADR ( 2 '4 ) 
27 
1 

NANADR (1*5) 
NANADR ( 2 / 5 ) 
19 

NANADRd  *6) 
NANADR ( 2*6) 
19 


:.-s> 

L'i'rlo 


!  TWENTY  SLOCKS 

!  BLOCK  ONE  ADDRESS  -  TARGT .LOOK 

!  BLOCK  ONE  ADDRESS 

!  WORD  COUNT  FOR  BLOCK  1 
!  TRAN  FLAG 

!  BLOCK  TWO  ADDRESS  -  XYZVC.LOOK 

!  BLOCK  TWO  ADDRESS 

!  WORD  COUNT  FOR  BLOCK  2 
!  TRAN  FLAG 

!  BLOCK  3  AODRESS  -  GLOBE. LOOK 

!  BLOCK  3  ADDRESS 

!  WORD  COUNT  FOR  BLOCK  3 
!  TRAN  FLAG 

!  BLOCK  4  ADDRESS  -  STARS. LOCK 

!  BLOCK  4  ADDRESS 

!  WORD  COUNT  FOR  BLOCK  4 
!  TRAN  FLAG 

!  BLOCK  5  ADDRESS  -  GLOBE. TROT 

!  BLOCK  5  ADDRESS 

!  WORD  COUNT  FOR  BLOCK  5 
!  BLOCK  6  ADDRESS  -  STARS. TROT 

!  BLOCK  6  ADDRESS 

!  WORD  COUNT  FOR  BLOCK  6 


IBUF (166) 


*  NANADRCI *7) 


!  BLOCK  7  ADDRESS 


GLOBE. EkOT 


IBUF(167) 
1BUF ( 1 68) 
IBUF  ( 188) 
IBUFC189) 
IBUF (190) 

IBUF (210) 
IBUF (211) 
IBUF(212) 
IBUF (220) 
IBUF  <  221 ) 
IBUF ( 222) 
IBUF ( 230) 
IBUF (231 ) 
IBUF(232) 
IBUF (240) 
IBUF  <  241 ) 
IBUF ( 242) 
IBUF (250) 
IBUF ( 251 ) 
IBUF ( 252) 
IBUF ( 260) 
I8UF( 261 ) 
IEUF<262) 
IBUF (266) 
IBUF (267) 
ISUF(268) 
IBUF (272) 
I8UF (273) 
IBUF (274) 
IBUF ( 278) 
IBUF (279) 
IBUF ( 280) 
IBUF (234) 
IBUF (285) 
IBUF (286) 
IBUF (294) 
IBUF ( 295) 
IBUF (296) 
IBUF ( 31 6) 
IBUF ( 31 7) 
IBUF ( 31 8) 


NAMADR (2*7) 
19 

NAMADRC1  rd) 
NAMADR(2*8) 
19 

NAMADR (1/9) 
NAM ADR ( 2/9) 

7 

NAMADROdO) 

NAMADR(2dC) 

7 

NAMADRCIdl) 
NAHA  DR  (  2d 1 ) 
7 

NAMADR (1  d  2) 
NAMADR(2d2) 
7 

NAMADR (1/13) 
NAMADR(2d 3) 
7 

NAMADR (1  d  4) 
NAMADR (2/14) 
3 

NAMAD  R(1d5) 
NAMADR(2d 5) 
3 

NAMADR (1/16) 
NAMAD  R  (  2  d  6  ) 
3 

NAMADR ( 1*17) 
NAMADR (2/17) 
3 

NAMADR ( 1  si  8) 
NAMADR (2/18) 
7 

NAMADR ( 1  d  9) 
N AMADR ( 2 d  9) 
19 

NAMADRd  *20) 
N  AMADR  (  2*20 
19 


!  BLOCK  7  ADDRESS 
!  WORD  COUNT  FOR  BLOCK  7 
!  BLOCK  S  ADDRESS  -  SATEL. 

!  BLOCK  8  ADDRESS  Vv* 

!  WORD  COUNT  FOR  BLOCK  8 


BLOCK  9  ADDRESS  -  XYPTH.TRN1 

BLOCK  9  ADDRESS 

WORD  COUNT  FOR  BLOCK  9 

BLOCK  10  ADDRESS  -  X  YPTH.  TRN2' 

BLOCK  10  ADRESS 

WORD  COUNT  FOR  BLOCK  10 

BLOCK  11  ADDRESS  -  XYPTH.TRN3 

BLOCK  11  ADRESS 

WORD  COUNT  FOR  BLOCK  11 

BLOCK  12  ADDRESS  -  X YPTH.TRN4 

BLOCK  12  ADRESS 

WORD  COUNT  FOR  BLOCK  12 

BLOCK  13  ADDRESS  -  XYPTH.TRN5 

BLOCK  13  ADRESS 

WORD  COUNT  FOR  BLOCK  13 

BLOCK  14  ADDRESS  *  INFO. RANGE 

BLOCK  14  ADRESS 

WORD  COUNT  FOR  BLOCK  14 

BLOCK  15  ADDRESS  -  INFO. RRATE 

BLOCK  15  ADRESS 

WORD  COUNT  FOR  BLOCK  15 

BLOCK  16  ADDRESS  -  INFO.RFUEL 

BLOCK  16  ADRESS 

WORD  COUNT  FOR  BLOCK  16  i  j 

BLOCK  17  ADDRESS  -  INFO.RWME 

BLOCK  17  ADRESS 

WORD  COUNT  FOR  BLOCK  17 

BLOCK  18  ADDRESS  -  XYPTH.SSTR 

BLOCK  18  ADRESS 

WORD  COUNT  FOR  BLOCK  18 

BLOCK  19  ADDRESS  -  XYPTM.ROTZ 

BLOCK  19  ADRESS 

WORD  COUNT  FOR  BLOCK  19 

BLOCK  20  ADDRESS  -  XYPTM.ROTX 

BLOCK  20  ADRESS 

WORD  COUNT  FOR  BLOCK  20 


SUBROUTINE  IOBUFF  (IFUNC/S/L/C/RESET) 

INTEGER  S(24)/L(24)/C(12) 

INTEGER  IFUNC/RESET 
INTE6ER*2  DATAOUT/DATAIN 
INTEGER*2  DIBUF(1O)/DO0UF(1O> 

INT£GER*4  ISTAT/ICALL 
INTEGER*4  NCHAN/ DOF '.AG/DIFLAG 

REAL  ARATE/RATE 

DATA  D0FLAG/DIFLAG/3/5/ 

DATA  NFRAME/10/ 

DATA  NODE OUT/NODE IN/ 8/7/ 

DATA  IUNIT/1/ 

DATA  ICHAN/1 / 

DATA  NCHAN/1/ 

DATA  ISNODE/O/ 

DATA  INIT/1 / 

DATA  RATE/80000.0/ 

GO  TO  (100/200)  IFUNC 

100  CALL  LPAIO  ( IMT/ IUNIT//RATE/// // ARATE/  1ST  AT/ 1 C  ALL/ r  ) 

IF  (.NOT.  ISTAT)  GO  TO  950 
RETURN 

200  CONTINUE 

OATAOUT*' 0000*  X 
DO  210  1*1/6 

210  DATA0UT*DATA0UT+L(I ) *2** ( 1-1 ) 

DO  220  1*1 zNFRAHE 

220  DOBUF (I)*DATAOUT  .XOR.  *  FFFF  *  X 

CALL  LPAIO  (NODEOUT/IUNIT/DOFLAG//ICHAN/NCNAN/NFRANE/DOBUF 
1  I ST AT / 1C ALL/ /I  SHOD E) 

IF  (.NOT.  ISTAT)  GO  TO  950 
CALL  SYSSWAITFR  (XVAL CDOFLAG ) ) 

250  CALL  LPAIO  (1 8// //// /// I  ST AT/ IC ALL/LSTAT/ ) 

IF  ((ISTAT. NE.-1). AND. (LSTAT.NE.1))  GO  TO  230 
CALL  LPAIO  (N0DEIN/IUNIT/DIFLAG//ICHAN/NCHAN/NFRAME/DI3UF/ 
1  ISTAT/ I CALL// I SMODE ) 

IF  (.NOT.  ISTAT)  GO  TO  950 
CALL  SYSSWAITFR  (XV AL(OIFLAG)) 

2 AO  CALL  LPAIO  ( 1 7// /////// I STAT/IC ALL/LSTAT/ ) 

IF  ((ISTAT. NE.-1). AND. (LSTAT.NE.1))  GO  TO  240 
DATAIN*(DIBUF(1).X0R.*FFFF*X> 

S (1 )*DATA IN  .AND.  1 
S(2)*(DATAIN  .AND.  2)/2 
S ( 3) * (DAT AIN  .AND.  4)/4 
S(4)*(DATAIN  .AND.  8)/8 
S ( 5 ) *  CD AT  A I N  .AND.  16)/16 
S(6)*(DATAIN  .AND.  32)/32 
RESET*! (64. XOR. DAT  AIN)  .AND.  64)/64 
DATAOUT**  4000*  X 
DO  250  1*7/15 

250  D ATAOUT*D ATAOUT*L( I) *2**(t”7) 

DO  260  1*1 /NFRANE 

260  OOBUF(I)*DATAOUT  .XOR.  'FFFF'X 

CALL  LPAIO  (K0DE0UT/IUNIT/D0FLAG//ICHAN/NCHAN/NFRANE/D03UF 
1  ISTAT/ICALL//ISNODE) 


v.I*rv 
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IF  (.NOT.  ISTAT)  GO  TO  950 
CALL  STSSWAITFR  (XVAL (OOFLAG > ) 

270  CALL  LPAIO  < 1 3** *** * * * * 1ST AT *1 C ALL*L$TAT*)  ,  > 

IF  <(ISTAT.NE.-1). AND. (LSTAT  .NE.1))  GO  TO  270  \z£r 

CALL  LPAIO  <M0D£IN*IUNIT*DIFLAG**ICHAN*NCWAN*NFRANE*DI3UF** 

1  ISTAT*ICALL**ISNOD£) 

IF  (.NOT.  ISTAT)  GO  TO  950 
CALL  STSSWAITFR  (X VAL < D I FL AG ) ) 

230  CALL  LPAIO  < 1 7** ** ** * ** I  ST AT# I C ALL*LSTAT* ) 

IF  ((ISTAT. NE.-1). AND. (LSTAT. NE.1))  GO  TO  280 
DATAINsIDiaUFOJ.XOR.'FFFF'X) 

S<7) *DATA IN  .AND.  1 
S(8)-(DATAIN  .AND.  25/2 
S(9) *<DAT  AIN  .AND.  4)/4 
S( 1 0)  =  ( D AT A  IN  .AND.  8)/8 
S(11)=(DATAIN  .AND.  16)/16 
S(12)  =  (DATAIN  .AND.  32 > / 3 i 
S  <1 3)  =  <  DATA  IN  .AND.  64>/64 
S(14)=(DATAIN  .AND.  1285/12S 
S( 15) =  (DATA  IN  .AND.  256)/256 
DATA0UT=*8000'X 
DO  290  1=16*24 

290  DATACUT=DATA0UT+L(I)*2**(I“16) 

DO  3C0  1  =  1  *  NFRANE 

300  D08UF (I)  =  DATAOUT  .XOR.  *  F F F F  *  X 

CALL  LPAIO  O,l0DE0UT*IUNIT*D0FLAG**ICHAN*NCHAN*NFRA*E*D0BUF** 

1  ISTAT*ICALL**ISMODE) 

IF  (.NOT.  ISTAT)  GO  TO  950 
CALL  STSSWAITFR  ( X VAL < DOFL AG ) ) 

310  CALL  LPAIO  ( 1 3* *  * * ** ** *  I  ST  AT  *  I C ALL*LST AT* > 

IF  <(ISTAT.NE.-1). AND. (LSTAT. NE.1))  GO  TO  310  ' 

CALL  LPAIO  (MODEIN*IUNlT*DIFLAG**ICHAN*NCHAN*NFRAHE*DIBUF** 

1  ISTAT*ICALL**ISMOOE) 

IF  (.NOT.  ISTAT)  GO  TO  950 
CALL  STSSWAITFR  < X VAL < D I FL AG  )  ) 

320  CALL  LPAIO  <1 7* *  *  * ** ** *  I  ST  AT  * IC ALL*LST AT* ) 

IF  ((ISTAT.NE.-D.ANO. (LSTAT. NE.1))  GO  TO  320 
DATAIN=(DIBUF(1).X0R.*FFFF*X) 

S(16)=DATAIN  .AND.  1 
S(17)=(DATAIN  .AND.  2)/2 
S(18)=(DATAIN  .AND.  4)/4 
S(19)=(DATAIN  .AND.  8>/8 
S(20)=(DATAIN  .AND.  1 6) /I  6 
S  <  21 )  =  (DATAIN  .AND.  32)/32 
S( 22)=(DATAIN  .AND.  64)/64 
S(23)*(DATAIN  .AND.  128)/128 
S<  24)  =  <DATAIN  .AND.  256)/256 
DATAOUT=* COOO'X 
DO  340  m  *  NFR AME 

340  DOBUF  (I)  =  DATAOUT  .XOP.  *  F  F  F  «'  *  X 

CALL  LPAIO  (MODEOUT* IUNIT* DOF L AG* *  I C H AN  * NC H AN* N F R AME * D 08UF* * 

1  ISTAT*ICALL**IS*ODE> 

IF  (.NOT.  ISTAT)  GO  TO  950 
CALL  STSSWAITFR  ( XV AL (DOFL AG) ) 

350  CALL  LPAIO  < 1 8** ** ** * ** I  ST AT  * IC ALL*L ST AT  * ) 

IF  ((ISTAT. NE.-1). AND. (LSTAT. NE.1>)  GO  TO  350 

CALL  LPAIO  (MODE  IN* IUNIT*  DIFLA6** I  CHAN* NCHAN*NF RAPE* DXBUF*^-V. 

1  ISTAT*  ICALL**ISMOD£) 

IF  (.NOT.  ISTAT)  GO  TO  950 
CALL  STSSWAITFR  ( % V AL ( D I F L AG ) ) 


CALL  LPAIO  (17s«*ssssssXSTATsICALL'LSTATs) 

IF  <<ISTAT.N£.-1).AND.(LSTAT.NE.1))  60  TO  360 
DATAIN«(»I3Ur(1>.X0ft.*FFFF,X) 

C(1)*C1.X0R.DATAIN)  .AND.  1 
C(2)*(<2.XOR.DATAIN)  .AND.  2)72 
C( 3>* (DAT AIN  .AND.  4)74 
C(4)*(DATAXN  .AND.  8)78 
C(5)*(DATAIN  .AND.  16)/16 
C(6)*(DATAIN  .AND.  32)732 
C(7)*(DATAIN  .AND.  64)/64 
C ( 8) * (D  AT  AIN  .AND.  128)/12S 
C (9) * (DAT  A I N  .AND.  256)/2S6 
C'10)*<DATAIN  .AND.  512)7512 
C( 11 )*<DATAIN  .AND.  1024)71024 
C(12)*(DATAIN  .AND.  2048)72048 
RETURN 

CONTINUE 

WRITE  (5/1950)  XSTAT#ICALL 

FORMAT  (*  ERROR  XN  CALL:  STATUS  =  FROM  CALL  #*/I6) 

CALL  EXIT 


SUBROUTINE  L I  NT  EG ( X, ON EG A , A, DE IT AT ) 

THIS  IS  A  FIRST  ORDER  INTEGRATION  SCHENE  FOR  TRANSLATIONAL 
ACCELERATIONS  IN  THE  REF  CC-U)  FRAME  USING  C-W  EOUATIONS  l' 

REAL  X(6)rXD0T(6)*A(3)*0MEGA/DELTAT 
INTEGER  J 

A<  1  -3)  -  XrY/-Z  ACCELERATION 
X  C  1  —  3  )  -  X/Yi-Z  POSITION 
X<4-6)  -  X,Y,Z  VELOCITY 
DELTAT  -  TIME  STEP 

OMEGA  -  ANGULAR  RATE  OF  TARGET  A30UT  EARTH 

XDOT  <1 )=X<4) 

XDOT  <2)*X (5) 

XDOT ( 3) *X  <6 ) 

8EL0W  ARE  THE  LINEARIZED  EOUATIONS  OF  MOTION  FOR  AN  INTERCEPT 
VEHICLE  RELATIVE  TO  A  TARGET  VEHICLE  IN  A  CIRCULAR  ORBIT 
WITH  KEPLARIAN  MOTION 

XDOT (4) =A  <1 >-2.0*0MEGA*XC5) 

XDOT(5)=A(2)>3.0*OMEGA*OMEGA*X(2)*2.0*OMEGA*X(4) 
XDOT(6)=A(3)-X<3) *OMEGA*OMEGA 

DO  100  J  =  1»6 

X(J)3X(J)+DELTAT*XD0T(J) 

CONTINUE 
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SUBROUTINE  LOOK (Ts XsOMEGA,T I ME, FUEL, IBUFs CH ANs I 0S3) 

C 

C  DETERMINES  WHERE  CAMERA  IS  POINTING  (AT) 

C  FROM  SHUTTLE  POSITION  ( X1sX2sX3 >  AND  TRANSFORMS 

C  FROM  RH  TO  LH  CARTESIAN  COORDINATES  (FM) 

C  FOR  VIEWING  ON  EVANS  t  SUTHERLAND  PS3C0. 

C  DETERMINES  UP  VECTOR  FOR  PS300  AND  COMPUTES 

C  EARTH  AND  STAR  ROTATIONS  AND  POSITION  OF  HORIZON. 

C  ALSO  COMPUTES  HEADS  UP  DISPLAY  DATA. 

C  INFORMATION  IS  THEN  SENT  TO  THE  PS300  FOR  DISPLAY. 

C 

INCLUDE  ' CALFAN03PR0C0NST. FOR/NOLI  ST* 

REAL  CAM(3>sT(3s3>sX<6)sHAT(*s*) 

REAL  OMEGAs T I MEsUP< 3) sRR AT Es FUELs RANGE sDT 
REAL**  TROTs£ROTsAT(3)sFM(3)sV(3)sUPPS(3)sRSAT 
REAL**  XYPTH(3)sNEWX(3)sBMAT(3s3)sBVEC (3) s AM AT (3/ 3) 

C 

INTEGER**  CHANsSYSSQIOsSYSSQIOW 
INTEGER*2  IOS8(*)s IBUF (337) 

C 

C  COMPUTE  SHUTTLE  POSITIONS  RANGE  AND  RANGE  RATE 

C  WRT  C-W  FRAME  (IN  LH  SYSTEM). 

C 

FM(1 )*X<1) 

FM(2)*X(2) 

FM<3 )*~X( 3) 

C 

RANGE*SQRT(X(1)**2+X(2)**2+X(3)**2) 
RRATE*(X(1)*X(A)+X(2)*X(5)*X(3>*X(6))/RANGE 
IF  (ABS(RRATE)  .LT.  .1)  RRATE*0. 0 
C 

C  COMPUTE  SHUTTLE  POSITION  AND  SCALE  DOWN  FOR 

C  HUD  XYPTH  DISPLAY. 

C 

XYPTH(1)*X(1)/100. 

XYPTH(2)*X(2)/100. 

XYPTH(3)*-X(3)/100. 

C 

C  ASSIGN  VALUES  TO  CAMERA  LOOK  VECTOR  IN  BODY  FRAME 

C  (I.  E.  -  LOOK  UP  OUT  OF  PAYLOAD  BAY) 

C 

C AM(1 ) *0. 

C AM( 2 ) *0. 

CAM(3)*-1000. 

C 

C  TRANSFORM  TO  REF  FRAME 

C 

CALL  BTOR(TsCAMsAT) 

C 

C  ADD  SHUTTLE  POSITION  TO  CAMERA  VECTOR  (REF  FRAME) 

C  AND  CONVERT  TO  LEFT  HANDED  GRAPHICS  COORDINATE  SYSTEM. 

C 

AT(1 ) * AT ( 1 ) *F  M (1 ) 

AT(2)*AT(2)+FM(2) 

AT(3)*-AT(3)*FM(3) 

C 

C  ASSIGN  VALUES  TO  UP  VECTOR  IN  BODY  FRAME. 

C  (I.  E.  -  OUT  NOSE  OF  SHUTTLE) 

C 


non  n  r»  n  ooo  o  r>  n 


p-T^TTi 
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UP(1  >=1000. 

UP<2>=0. 

UP  <  3  >  =0 . 

C 

C  TRANSFORM  TO  REF  FRAME#  TRANSLATE  TO  'AT'  IN  LH  SYSTEM 

C 

CALL  3T0R(T#UP#UPPS) 

C 

UPPS(1)=AT(1)+UPPS(1) 

UPPS(2)=AT(2)+UPPS<2> 

UPPS ( 3) =AT(3)-UPPS(3> 

C 

C  CONVERT  AT/FM  AND  UPPS  FROM  FEET  TO  METERS 

C 

AT(1  )=AT<1>*.  3048 
AT(2)=AT(2>*. 3048 
AT(3)=AT(3>*. 3048 
FM(1)=FM(1)*.3048 
FM(2)=FM(2>*. 3048 
FM(3)=FM(3)*.3048 
UPPS(1)=UPPS(1)*.3C48 
UPPS(2)=U?PS(2)*.3C48 
UPPS(3)=UPPS(3)*. 3048 

DETERMINE  EARTH  ROTATION  (DES) 

ER0T=TIME*. 0041 78075 

DETERMINE  TARGET  ROTATION  (DEG) 

TROT  *  0MEGA*57.29577951*TIME 

DETERMINE  SATELLITE  SPIN  (DEG) 

RSAT=-TIME*30.G 

SEND  INFORMATION  TO  PS300 

C 

CALL  P919CV(XYPTH#3# IBUF (287) > 

CALL  R0T(90.#1# AMAT) 

CALL  P919CV( AMAT#9, I8UF (31 9) ) 

CALL  TLHT(TzAMAT) 

CALL  P919CV(AMAT#9# IBUF (297) ) 

C 

CALL  R0T(RSAT/1#AMAT) 

CALL  P919CV(AMAT#9,I3UF(191  )) 

CALL  R0T(-6R0T# l, AMAT) 

CALL  P919CV( AMAT#9/I8UF(1 69)  ) 

CALL  R0T(TR0T#3#AMAT) 

CALL  P919CV(AMAT#9#I0UF(125)) 

CALL  P919CV(AMAT/9#IRUF(147) ) 

C 

CALL  L00<AT(AT/FM,UPPS/3MAT#BVEC) 

CALL  P919CV (9MAT  #9# I3UF  (5)  ) 

CALL  P91RCV(BVEC/3#I9UF(25)) 

CALL  P919CV(BMAT#9#I9UF(55)> 

CALL  P919CV(BVEC#3#I3UF(55)) 

C  CALL  t»SNREA(RANGE*.01/1#'XYZVECSCL'/ERR) 
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C 

C  RESCALE  TO  DUS 

C 

DO  57  1*1,3 

AT(I)=AT(I>/6378135. 

FM(I)=*FM(I)/63781 35. 

UPPS(I)=UPPS(I) /6378135. 

57  CONTINUE 

C 

CALL  LOOKAT(AT*FM*UPPS*SWAT*BVEC> 

CALL  P919CV(BMAT*9*I8UF(65)> 

CALL  P919CV(8VEC*3*I3UF(85)) 

CALL  P919CV(3MAT*9*I8UF(95)  ) 

CALL  P919CV(BVEC*3*iaUF(115)) 

C 

CALL  NUN8ER(RANGE*I0UF(263)) 

CALL  NUHBER(RRAT£*IBUF(269>> 

CALL  NUMBER(FU£L*IBUF(275)) 

CALL  NUMBER(TIHE*IBUF(281)) 

C 

C  CONPUTE  FUTURE  POSITIONS  FOR  HEADS  UP  DISPLAY 
C  AND  SEND  TO  PS300  (OT  IS  TINE  INCREMENT) 

C 

DT*300. 

CALL  PREDPATH(OHEGA,DT*X/NEWX) 

CALL  P919CV(NEWX*3*IBUF(213>> 

CALL  PREDPATH(OH£GA*2.*DT*X/NEWX) 

CALL  P919CV(NEWX*3*I8UF(223)  ) 

CALL  PREDPATH(CHEGA*3*DT*X*NEWX> 

CALL  P919CV(NEWX*3*IBUF(233>> 

CALL  PREDPATH(0HEGA*4„*DT*X#NEWX) 

CALL  P919CV(NEWX*3*IBUF(243)) 

CALL  PREDPATH(OHEGA*5. *DT,X*NEWX) 

CALL  P919CV(NEWX*3*I8UF(253)) 

C  DO  A  WRITE  SYNC 

C  42  WRITE  SYNC  FUNCTION  CODE 

C  IOSB  10  STATUS  SLOCK 

C  I9UF  DATA  BUFFER  (ACTUALLY  ADDRESS  OF  BUFFER*  BY  REFERENCE) 

C  674  DATA  BYTE  COUNT  (337  WORDS) 

C  0  NOT  CHARACTER  DATA  (1  =  CHARACTER  DATA) 

C 

C  SEND  ALL  DATA 

C 

STATUS=SYSS9I0«VAL(1)*XVAL(CHAN)*XVAL(42),I0S9,*r 
♦  IBUF(1)*XVAL(674)*XVAL(0)***) 

C 

IF  (STATUS  . NE.  1)  THEN 

TYPE  ** ' 3 AD  WRITE  <ST ATU S *  I  0 S 9 > ' , ST ATU S *  I OS  9 
STOP 
ENDIF 
C 

ENO 

C 

C 

C 

C 

SUBROUTINE  ROT ( ANGLE  *  I AXI S / ANAT ) 

C 

C  ROUTINE  TO  GENERATE  ROTATION  REflUSSTS  TO  PS300 
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c 

C  CALLING  SEQUENCE: 

c  ■■■; 

C  CALL  R0T< ANGLE/IAXIS/AMAT) 

C  .V  V 

C  WHERE:  X 

C 

C  ANGLE  IS  THE  REAL*4  ANGLE  FOR  ROTATION/  IN  DEGREES.  NEED  NOT  3E  LIMITED 

C  TO  A  SINGLE  CIRCLE.  X 

C  I A  X I S  IS  THE  INTEGER*2  AXIS  OF  ROTATION  (1  =  X/  2  =  Y/  3  =  Z>.  V 

C  AMAT  IS  THE  HEAL  3X3  MATRIX  CALCULATED  X 

C  X 

C 


C 

c 


10 


c 

c 

c 

c 


INT£GER*2  IAXIS/I/J 

REAL  ANGLE/ AMAT( 3/ 3) /PI1 80 

DATA  PI18G/0.01 7453/ 

I0X(I)=M0D(I+2/3)+1  !  STATEMENT  FUNCTION  (NOT  AN  ARRAY) 


IFQAXIS.LT.1.0R.IAXIS.GT.3)  STOP 

DO  1C  1=1/3 

DO  10  J  =1 / 3 

AMAT ( 1/ J ) =0. EO 

RADIAN  =  ANGLE  *  PI180 

C=COS(RADIAN> 

S=SIN(RADIAN) 
AMAT(IAXIS/IAXIS)=1.E0 
I=IDX (IAXIS-1 ) 

J=IDX(I AXIS+1 ) 

AM  AT  (  1/  1  )  =C 

AMAT(J/J)=C 

AMAT(I/J)=S 

AMATC J/I) =-S 

RETURN 

END 


PSLI3--AXIS  OUT  OF  BOUNDS* 


SUBROUTINE  TLHT(TzAMAT) 


C 

C  ROUTINE  TO  CONVERT  A  RIGHT  HANDED  ROTATION  MATRIX  (T) 

C  TO  A  LEFT  HANOED  POTATION  MATRIX  (AMAT) 

C 

C  CALLING  SEQUENCE: 

C 

C  CALL  TLHT (T/AMAT) 

C 

REAL  AMAT (3/3)/T<3/3> 

C 

AMA  T ( 1 / 1 ) =T ( 1 / 1 ) 

AMAT  C  2/ 1 ) =T ( 2/ 1 ) 

AMAT(3/1)=“T ( 3/1 ) 

AMAT (1/2) =T (1/2) 

AMAT(2/2)=T(2/2) 

AMAT(3/2)=-T(3/2) 

AMAT(1/3)=-T(1 /3) 

AMAT(2/3)=-T(2/3) 

AMAT(3/3)=T(3/3) 


AD-A162  461 
UNCLASSIFIED 


STS  (SPACE  TRANSPORTATION  SVSTEH)  TASK  SIHULATOR(U)  AIR 
FORCE  ACADEHV  CO  S  ALFANO  IS  AUG  85  USAFR-TR-85-12 

F/G  9/2 


2/2 


«- / 


RETURN 

END 

C 

C 

c 

c 

SUBROUTINE  P919CV(MATRIX*N*BUFFER> 

C 

C  ROUTINE  TO  CONVERT  A  VAX  REAL  ARRAY  TO  ACP  FLOATING-POINT  FORMAT 

C 

C  THIS  ROUTINE  CONVERTS  AN  ARRAY  OF  VAX  SINGLE-PRECISION  REAL  NUMBERS  INTO 
A  NORMALIZED  ARRAY  OF  32-BIT  ACP  MANTISSAS*  WITH  THE  ARRAY  PRECEDED  BY 
C  A  16-BIT  EXPONENT.  THE  MOST  SIGNIFICANT  ELEMENT  IN  THE  ARRAY  IS  NORMAL- 
C  I  ZED. 

C 

C  FORTRAN  CALLING  SEQUENCE: 

C 

C  CALL  P919CV(MATRIX*N*BUFFER> 

C 

C  WHERE: 

C 

C  MATRIX  IS  AN  N-ELEMENT  RE AL*4  ARRAY  OF  VAX  FLOATING-POINT  NUMBERS. 

C  N  IS  THE  INTEGERS  SIZE  OF  ARRAY  MATRIX. 

C  BUFFER  IS  THE  INTEGERS  ARRAY*  OF  LENGTH  2N+1*  INTO  WHICH  THE  RESULT  IS 
C  PLACED*  WITH  THE  EXPONENT  WORD  FIRST*  FOLLOWED  BY  THE  ARRAY  OF 

C  32-BIT  MANTISSAS. 

C 

C 

INTEGERS  N*BUFFER(2*N+1}*FWORD(2) 

REAL  MATRIX(N)*DMAX 

INTEGER**  PSMEXP*PSMFRA*PSMNOR*DWORD*EDWORD 
EQUIVALENCE  C DWORD* F WORD ( 1 ) ) 

C  FINO  LARGEST  REAL  NUMBER  TO  OBTAIN  EXPONENT 

DMAX*0. 

DO  10  1*1 *N 

10  0MAX*AMAX1(0MAX*ABS(MATRIXCI)>) 

C  USE  EXPONENT  OF  LARGEST  NUMBER  FOR  NORMALIZATION 

DWORD*PSMEXP<OMAX) 

BUFFER(1)*FWCRD(1) 

EDWORD*DWORD 

C  OBTAIN  NORMALIZED  FRACTIONS  AND  LOAD  INTO  BUFFER 

DO  20  1*1 *N 

DWORD*PSMNOR (MATRIX < I) *EDWORD) 

BUFFER(2*I)*FWORD(2) 

BUFFER (2*1+1 )*FW0RD(1) 

20  CONTINUE 

RETURN 
END 
C 
C 
C 
C 

SUBROUTINE  LOOKAT(AT*FM*UP*MAT*VEC> 

C 

C  ROUTINE  TO  GENERATE  LOOK  AT*  LOOK  FROM* 

C  LOOK  UP  REQUEST  TO  THE  PS300 

C 

C  THIS  ROUTINE  UPDATES  A  PS300  DISPLAY  LOOK  NODE 

C  WITH  THE  NECESSARY  LOCK  MATRIX 

C 
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A 


CALLING  SEQUENCE: 

CALL  LOOKAT(AT*FM*UP*MAT*VEC) 

WHERE: 

INDEX  IS  THE  INTEGERS  NODE  SUFFIX  d <* I ND EX<=256) 
WHICH  CORRESPONDS  TO  ONE  OF  THE  DISPLAY  STRUCTURE 
NODES  NOOI  THROUGH  N2S6. 

AT *  FM*  UP  :  ARE  THE  VIEWING  VECTORS 

"AT  :  IS  THE  RESULTING  3X3  VIEWING  MATRIX 

SUFFER  IS  THE  INT £GE  R*  2  ARRAY*  OF  LENGTH  2N*1* 

INTO  WHICH  THE  RESULT  IS  PLACED*  WITH  THE  EXPONENT 
WORD  FIRST*  FOLLOWED  8Y  THE  ARRAY  OF  32-SIT  MANTISSAS. 
VEC  IS  A  3  ELEMENT  ARRAY  CONTAINING  ROW  4 

COMPUTES  4X4  MATRIX  FOR  LOOK  FUNCTION 

REAL  AT(3>*FMC3)*UPC3)*MAT<3*3)*T(3)*V£CC3) 

REAL  D(3)*E(3)*M*F(3)*G<3)*H(3)*MAG 

0<1>*AT<1)-FM<n 

D(2)*AT(2)-FM(2) 

0(3>*AT<3)-FH<3> 

NAG*DC1)**2+D(2)**2>D<3)**2 
IF  (MAG  .GT.  .IE-30)  THEN 
MAG*SQRT( MAG) 

ELSE 

NAG*. IE-30 
ENDIF 

D<1)*Dd)/MA6 
D(2)=D(2)/MAG 
D ( 3) =D ( 3) /NAG 

E(1)=UP(1)-AT(1) 

E(2)*UP(2)-AT(2) 

E(3)*UP(3)-AT(3) 

M*D(1)*E(1)>DC2)*E(2)+D(3)*E<3) 

Fd)*Ed)-K*D(1> 

F(2)*E(2)-M*D(2) 

F(3)=E(3)-M*D<3> 

IF  <(F(1)+F<2)*F(3))  .EQ.  O.O)  THEN 
E(1 ) *0.0 
E(2)=1.0 
E<3)*0.0 

F«1)*E(1)-M*DO) 

F(2)*E(c) -M*0 ( 2 ) 

F(3)*E(3)-M*D(3> 

IF  <(F(1)+F<2)+F(3))  .EQ.  0.0)  THEN 
E<1 >*0.0 
E(2>*0.0 
E<3)*1. 0 

F(1  )*Ed)-P*Dd> 

F(2)*E(2)-N*D (?) 

F(3>*E(3)-P*0(3) 

ENOIf 


m  km 

^  m 


m 


► .  ■ .  - 


V  *,  N 

v."1  %  - 


ENDIF 

MAG*SGRT(F(1)**2+FC2>**2*F(3>**2> 

6<1}*F(1)/NAG 
G(2)*F(2)/MAG 
6(3) *F(3) /MAG 

H(1)*G(2)*D(3)-G(3)«0(2) 

H(2)*6(3>*D(1)-G(1)*D(3> 

M(3)*6(1)*D(2)-6(2>*D(1} 

T(1)*-FM(1)*H(1)-FN(2)*h(2)-FN(3)*H(3) 
T(2)*-FH(1)*G(1)*FM(2)*G(2>~FM(3)*G(3> 
T(3) *-FW( 1 > *D( 1 >-FP( 2) *D (2 >-FM (3) *D (3) 

NAT( 1*1 )*H(1 ) 

HAT(1*2)*N(2) 

MAT(1*3)*H(3) 

VEC(1)*T(1) 


MAT  ( 2* 1 )*6(1 ) 
MAT(2*2)*G(2) 
MAT(2*3)*6(3) 
VEC(2>*T(2> 

NAT(3*1)*D(1) 
"AT(3*2)*D(2) 
MAT ( 3*  3)*D( 3) 
VEC(3)*T(3) 


RETURN 

END 


SUBROUTINE  P920CV(MAT*VEC*3UFF ER> 

THIS  SUBROUTINE  FILLS  IN  A  4  X  4  ARRAY  INTO  THE  BUFFER. 

YOU  LOAD  A  3  X  4  NAT*  AND  AN  ARRAY  VEC<3>  IS  THE  FOURTH  ROW. 
IT  FILLS  34  ELEMENTS  IN  THE  BUFFER. 

INTEGERS  ITEMPK9)*  ITEMP2(25>*  9UFF£R<34> 

REAL  MAT(3*4>*  VEC (4 ) * MAT1 (4 *  3) 

DO  100  1*1*3 
DO  99  J*1*4 

MAT1(J*I)*MAT<I*J) 

CONTINUE 

CONTINUE 

CALL  P919CV(VEC*4*ITEMP1) 

CALL  P919CV(MAT1*12*ITEMP2) 

BUFF  ER  (1 )  *  ITEMPK1) 

DO  5  I  *  1*25 

8UFFER(I*1 )  *  ITEMP2(I) 

CONTINUE 
DO  10  J  *  1*8 

BUFFER(J*26)  «  ITEMPl(JM) 

CONTINUE 


v' 

V.  V 
v  * • 

.  .  *< 


f 


RETURN 

END 


SUBROUTINE  NUMBERCX/BUFFER) 

THIS  SUBROUTINE  WILL  TARE  ANY  NUMBER  FROM  9999.9  TO  -999.9 
ENCODE  IT/  AND  PUT  IT  IN  THE  PROPER  PLACE  IN  THE  OUTPUT 
BUFFER/  IBUF 

INTEGERS  BUFFER<3) /  T3UF(3> 

CHARACTERS  CHAR 
LOGICAL  *1  TEMPO/TEMPI (6) 

EQUIVALENCE  (CHAR/TEMP1/T8UF) 

IFCX.ST.9999.9)  X=9999.9 
IFCX.LT.-999. 9)  X=-999.9 
ENCODE! 6/ 201 /CHAR) X 
FORMAT (F6.1 ) 

TEMP0*TEMP1 <1) 

TEMPI  Cl )*TEMP1 (2) 

TEMPI <2)*TEMP0 
TEMP0*TEMP1 C3) 

TEMPI <3)=TEMP1<4) 

TEMPI U)*TEMPQ 
TEMP0=TEMP1 <5) 

TEMPI (5)aTEMP1 (6) 

TEMPI (6)=TEHP0 
8UFFER(1)ST3UF<1) 

3UFFER<2)=TBUF  <2) 

8UFFER(3)3T3UF(3) 

RETURN 


«<  LPAIO  »»  LPAll-K  I/O  ROUTINES;  J.R.  LINO;  03  RAY  83;  REV  C 

SUBROUTINE  LPAIO  (RODE, IUNIT, I FLAG, DR ATE, I CHAN,NC HAN, NFRARE, I09UF, 

1  ARATE, ISTAT , IC ALL,LSTAT, I  SHOD  E) 

REV  A  DESIGNED  TO  USE  AST  CALLS  AT  COHPLETION  OF  SWEEP  (FILE  NARE  LPAIOA. 

REV  B  RODXFXED  TO  USE  EVENT  FLAGS  INSTEAD  OF  AST  CALLS  03  FEB  83  (JRL) 

REV  C  RODIFIED  TO  AOD  I/O  NODE  CALLING  PARANETER  "ISRODE"  AND  TO  ALLOW 

FOR  2  CHANNEL  DIGITAL  I/O  WITH  THE  ADDITION  OF  NODES  7,6*17,  6  18. 


CALLING  SEPCIFICATIONS: 

RODE  * 


RODE  OF  CALL  WITH: 


NODE  *  1  INITIALIZE  LPAll-K  UNIT  IUNIT 

*  3  ANALOG  INPUT 

*  4  ANAL06  OUTPUT 

*  5  DIGITAL  INPUT  A 

*  6  DIGITAL  OUTPUT  A 

*  7  DIGITAL  INPUT  B 

*  8  DI6ITAL  OUTPUT  B 
>13  ANALOG  INPUT  STATUS 
>14  ANALOG  OUTPUT  STATUS 
*15  DIGITAL  INPUT  STATUS  A 
*16  DIGITAL  OUTPUT  STATUS  A 
*17  DIGITAL  INPUT  STATUS  B 
*18  DI6ITAL  OUTPUT  STATUS  B 

IUNIT  UNIT  NURBER  OF  THE  DESIRED  LPA11  SUB5YSTEN: 

IUNIT  *  0  USES  LAAO: 

*  1  USES  LABO: 

I  FLAG  NURBER  OF  THE  EVENT  FLAG  WHICH  IS  TO  BE  SET  A  CONPL 
DRATE  DESIRED  SARPLE  RATE  (DO  NOT  EXCEED  80  KHZ) 

ICHAN  START  CHANNEL  NURBER 

NCHAN  NURBER  OF  CHANNELS  (RUST  BE  1  FOR  DIGITAL  I/O) 

NFRARE  NURBER  OF  FRARES  (NCHAN  PER  FRAHE) 

IOBUF  BUFFER  FOR  DATA  (NFRARE  •  NCHAN  2  BYTE  WORDS  LONG) 


RETURNED  INFORRATION: 


ARATE  ACTUAL  SARPLE  RATE  USED  (0  FOR  ERROR) 
ZSTAT  THREE  WORD  ARRAY  WITH: 


ISTAT  *  0 
*  1 
*  X 


ERROR  IN  CALL 
SUCCCESFUL 
VRS  ERROR  CODE 


LSTAT  INTEGER*!  <8YTE)  VARIABLE  USER  WITH  ISTAT  TO  DEFI 


2CALL 


ISTAT  LSTAT 


MEANING 


0  0  NORMAL  -  BUFFER  0  DONE 

*1  1  SWEEP  TERMINATED  OK 

-1  X  X  *  LPA11  ERROR  CODE  (USER'S  6D  P 

CALL  NUMBER  OF  THIS  PROGRAM  (RELATES  TO 
LPA11  I/O  FUNCTION  WHICH  WAS  LAST  USED  BEFORE 
RETURN  TO  THE  CALLIN6  PROGRAM) 

IF  ICALL  =  0/  THEN  NODE  IS  UNDEFINED! 


ISMODE  SPECIFY  MODE  OF  LPA11  SWEEP 


C  NOTES: 
C 


C  WARNINGS: 
C 


FOR  MODES  5  -  8  (DIGITAL  I/O),  NCHAN  MUST  BE  1. 

CHANNEL  NUMBERING  ALWAYS  STARTS  WITH  0. 

IN  MODE  1#  THE  SAMPLE  RATE  OF  THE  LPA11  CLOCK 
IS  SET/1  AND  THE  SAME  RATE  IS  USED  ON  ALL  LPA11  FUNCTIONS. 
DRATE  MUST  NOT  EXCEED  80  KHZ.  HOWEVER#  THE  LPA11  USER'S 
MANUAL  SPECIFIES  MAXIMUM  AGGREGRATE  THROUGHPUT  FOR  MULT IB 
ACTIVITIES  AT  IS  KHZ  FOR  ALL  OPERATIONS  COMBINED.  (PARA  2 

WE  SPECIFYING  ISMODE  *  512  IN  THE  DIGITAL  INPUT  MODE# 

ONLY  ONE  CHANNEL  OF  DIGITAL  I/O  CAN  BE  USED  AT  A  TIME. 
OTHERWISE#  THE  PROGRAM  WILL  HANG  WAITING  FOR  THE  INPUT 
FLAG  TO  BE  SET  BY  THE  LPA11.  WHEN  USING  ONLY  ONE 
CHANNEL  OF  0 IGXTAL  I/O#  THE  ISMODE  *  S12  WILL  WORK 
PROPERLY.  IF  ISMODE  *  0  IS  SPECIFIED  FOR  BOTH  DIGin-- 
INPUT  CHANNELS#  THEN  TWO  CHANNELS  MAY  BE  USED  AT  THV^j?  * 
SANE  TIME.  ■ 


WHEN  USING  A/D  OR  D/A  MODE#  YOU  MUST  SPECIFY  AN  ISMODE 
OF  64  IN  ORDER  TO  USE  THE  MULTIREQUEST  MICROCODE  WHICH 
IS  LOADEO  BY  THIS  ROUTINE. 


C  1.  IN  THE  CASE  OF  DIGITAL  OUTPUT#  THE  MODE  OF  THE  LPA11  IN 

C  RUNNIN6  THE  DR11-K  IS  TO  START  OUTPUT  IMMEDIATELY  (THE  MODE  SPEICIFED 
C  IN  THE  CALL  SHOULD  BE  ISMODE  =  0.) 

C 

C  2.  IN  THE  CASE  OF  DIGITAL  INPUT#  THE  MODE  OF  THE  LPA11  IN 

C  RUNNING  THE  DR11-K  IS  TO  START  INPUT  ON  EXTERNAL  TRIGGER  (THE  MODE 
C  SPECIFIED  IN  THE  CALL  SHOULD  BE  ISMODE  =  512).  THE  "EXTERNAL" 

C  TRIGGER  IS  ACTUALLY  THE  DR11-K  "EXTERNAL  DATA  READY"  LINE  FOR  THE 
C  EXTERNAL  DEVICE.  (SEE  DR11-K  TIMING  DIAGRAM  ON  PAGE  4-7  OF  THE 
C  DR11-K  INTERFACE  USER'S  GUT^E  AND  MAINTENANCE  MANUAL.) 

C  IN  THIS  MOOE#  INTERRUPT  WILL  OCCURR  ONLY  AFTER  THE  EXTERNAL  DEVICE 
C  CYCLES  THE  "EXTERNAL  DATA  READY"  LINE. 


C  3.  NOTE  THAT  THE  CONFIGURATION  OF  THE  DR11-K  JUMPERS  IS  VERY 

C  INPORTANT  TO  PROPER  OPERATION  OF  THE  DR11-K.  IN  PARTICULAR#  ALL 
C  SI  AND  S2  SWITCHES  SHOULD  BE  OFF  TO  DISAPLE  INTERRUPT  BY  TRANSITION 
C  OF  THE  OATA  BITS  (SEE  TABLE  5-3>.  IN  ADDITION#  JUMPERS  W5  -  W20 
C  MUST  BE  IN  POSITION  "9"  IN  ORDER  TO  READ  DATA  DIRECT  FROM  THE  DATA 
C  INPUT  LINES  (AS  OPPOSED  TO  THE  BUFFER  RE6ISTER  INPUT).  THIS  IS  V.-s. 
C  DUE  TO  THE  FACT  THAT  IN  "BUFFER  REGISTER"  MODE#  THE  INDIVIDUAL 
C  DATA  BITS  IN  THE  BUFFER  ARE  SET  ONLY  ON  TRANSITION  OF  THE  DATA  LINE 
C  (SEE  PARAGRAPH  4-6  OF  DR11-K  INTERFACE  USER'S  GUIDE).  SINCE 
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C  ALL  SWITCHES  ON  SI  ANO  S2  ARE  OFF#  THE  STATE  OF  JUMPERS  W1-W4  XS  A 
C  DON'T  CARE.  JUMPERS  W21-W23  SHOULD  BE  SET  FOR  APPROPRIATE  POLARITY 
C  Of  TNC  INTERNAL  DATA  ACCEPT  AND  INTERNAL  DATA  READY  LINES. 

C 

C  4.  RENBER  THAT  ON  DX6XTAL  OUTPUT#  THIS  PROGRAM  SPECIFIES  AT 

C  LEAST  A  150  MICROSECOND  DELAY  BEFORE  OUTPUT  OF  THE  FIRST  DI6ITAL  WORD 
C  {SEE  PAGE  2-14  OF  THE  LPA11  USER'S  GUIDE).  THIS  IS  NECESSARY 
C  IN  OROER  TO  ALLOW  TINE  FOR  THE  LPA11  TO  RETRIEVE  DATA  FROM 
C  MEMORY. 


.N/.VW 
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PARAMETER  USAGE 

NODE  XUNXT  I  FLAG  ORATE 


XCHAN  NC  HAN  NFRAME  IOBUF 


ww>t 


arav-; v  a. 


*r 

«• ,%  *• . 

-vii 

a 
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*****  program  declarations  ***** 

VARIABLE  DEFINITION  SECTION 

IOBUF  DATA  BUFFER  AREA  (INTEGER*2) 

XYBUF  LPA 1 1  CONTROL  SLOCK  (50  LONGWORDS) 

XTSTAT  LPA1 1  COMPLETION  STATUS  (FORM  LPASIGTBUF  CALL) 

IFLAG  LPA11  FLAG  TO  BE  SET  AT  COMPLETION  OF  SWEEP 

XYIOSB  I/O  STATUS  BLOCK  FOR  LPA11  <4  WORDS) 

DXIOSZ  I/O  STATUS  BLOCK  FOR  DIGITAL  I/O  TO  BUFFER  Z  (CM  A  OR  9) 

XYMSKB  LPA11  SUBSYSTEM  MASKS  AND  NUM  BUFFER 

ISTAT  LPA11  STATUS  LONGWORD 

LSTAT  LPA11  I/O  COMPLETION  STATUS  BYTE 

NBUF  NUMBER  OF  BUFFERS  TO  BE  FILLED  (LONGWORD) 

WHERE  "XY"  IS  AD  FOR  ANALOG-TO-D IGITAL 
DA  FOR  DIGITAL-TO-ANALOG 
D I  FOR  DIGITAL  INPUT 
DO  FOR  DIGITAL  OUTPUT 

VARIABLE  TYPE  SPECIFICATIONS 


«  •  >'*  *  ** 
r  4 


REAL 

INTEGER*4 

INTEGER*? 
INTEGER  *2 
INTEGER  *4 
INTE6ER*4 
INT£GER*4 
BYTE 

INTEGER*2 


LPASXRATE 

SYSSCLREF 

10BUF(1)sADI0$B(4)/DAI0SB(4) 

DIIOSA(4)#DOIOSA(4),DIIO$9(4)#DOIOSB(4> 

ADMSK9(2),DAMSKB(2) 

DIMSKA(2),DOMSKA(2)sDIMSKB(2)sDOMSKB(2> 

ISTAT#BUFNUM,N8UF,IFLAG 

IDSC#IEMC, LSTAT 

IDSW/IEMW 


SET  AREA  FOR  CONTROL 
XNTEGER*4 
INT£GER*4 
EQUIVALENCE 
EQUIVALENCE 
EQUIVALENCE 


AD8UF(50)#DABUF(SO) 

DIBUFA(50)#0OBUFA(5O)#DIBUFB(50)»DOBUFB(50) 
(ADIOSBd  ),ADBUF(1  ) ) # <0A IOSB <1 ) *D ABUFC1 > ) 

(DII0SAC1  >,DIBUFA(1  >  >,  (DOIOSACmDOBUFACOV- 

CDIlOSBO  )/DIBUF8(1  >  > , (0010 SB <1 > # D0BUF9C1 > a . 


'•  A  V. 
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C  *****  STMT  OF  PR06RAN  ***** 

C  DETERMINE  HOPE 
C 

C  LSTAT  »  0 

«0  TO  (100s SO* 300*400* 500*600* 700* 800# 50* 5 0*50# 50# 
t  1 300# 1400# 1500* 1600* 1700*1 800) sNODE 
C  EXECUTION  STARTS  HERE  IF  NOPE  IS  UNDEFINED 
50  ICALL  «  0 

ISTAT  •  0 
60  TO  1950 
C 
C 

C  *****  NODE  *  1  ***** 

C  LOAD  LPA11  SPECIFIED  8Y  IUNIT  WITH  NXCROCODE  FOR  NULTXREQUEST  NODE 
C 

100  CONTINUE 

ICALL  *101 

CALL  LPASLOADNC  <1sXUNXT*I$TAT#IERR0R) 

IF  (.NOT.  ISTAT)  60  TO  1950 
C 

C  USE  XRATE  ROUTINE  TO  CALCULATE  RATE  AND  PRESET  VALUES  FOR  CLOCK  A 
C 

C  RATES  ARE  SUPPLIED/RETURNED  BUT  LPASXRATE  REQUIRES  INTERVALS 
AINTRVL  *  1./DRATE 
ICALL  «  102 

ACTUAL  *  LPASXRATE  CAXNTRVL# XRATE#IPRSET#0> 

ARATE  *  1. /ACTUAL 
C 

C  SET  CLOCK  RATE  TO  SPECIFIEC  SAMPLE  RATE  (DO  NOT  EXCEED  ABOUT  80  KHZ) 
C 

ICALL  *  103 

CALL  LPASCLOCKA  < IRATE# XPRSET# I STAT# IUNIT) 

60  TO  1950 


v.v 


,V( 


c  *****  NODE  *  3  ***** 

C  START  ANAL06-T0-DIGITAL  INPUT  SWEEP 
C 

300  CONTINUE 
C 

C  CLEAR  A/0  EVENT  FLAG 
ICALL  *  300 

ISTAT  *  SYSSCLREF  (XVAL(XFLA6) ) 

IF  <.NOT.  ISTAT)  GO  TO  1950 
C 

C  INITIALIZE  AOBUF  ARRAY  FOR  SWEEP 
C 

ICALL  *  301 

CALL  LPASSETIBF  (AOBUF *IST AT/ ADMSKB* I09UF) 

IF  (.NOT.  ISTAT)  GO  TO  1950 
C 

C  SET  UP  FOR  LPA11  SUBSYSTEM  NUMBER 
C 

ICALL  *  302 

CALL  LPASLAMSKS  (AOMSKB* IUNIT) 

C 

C  RELEASE  THE  BUFFER  (BUFFER  NUMBERS  ARE  USED  RATHER  THAN  NAMES) 

C 

ICALL  *  303 

CALL  LPASRLSBUF  (A0BUF*ISTAT*0) 

IF  (.NOT.  ISTAT)  GO  TO  1950 
C 

C  START  A/0  SWEEP  BY  SPECIFYING  ONLY  ONE  BUFFER 
C 

NPOINT  »  NFRAME  *  NCHAN 
C  SPECIFY  ONLY  ONE  BUFFER  TO  BE  FILLED 
NBUF  *  1 

C  IN  REV  C  OF  THIS  ROUTINE*  ISMODE  IS  SPECIFIED  IN  THE  CALLING  PARAMETER 
C  PROCEED  WITH  SWEEP  START  CALL 

C  SWEEP  CALL  SPECIFIES  FLAG  BE  SET  AT  COMPLETION 
ICALL  =  304 

CALL  LPAlADSWP  ( ADBUF *NPOI NT *NBUF , I SMODE** XVAL ( I  FLAG > * * ICHAN* 

1  NCHAN* 1ST  AT) 

IF  (.NOT.  ISTAT)  GO  TO  1950 
C 
C 

C  RETURN  TO  CALLING  PROGRAM  ...  ISTAT  IS  STATUS  OF  A/0  SWEEP  CALL 
GO  TO  1950 


c  *****  MODE  *  4  ***** 

C  START  DIGITAL-TO” ANALOG  OUTPUT  SWEEP 
C 

400  CONTINUE 
C 

C  CLEAR  D/A  EVENT  FLAG 
ICALL  *  400 

ISTAT  *  SVSSCLREF  (XVAL(IFLAG) ) 

IF  (.NOT.  ISTAT)  60  TO  1950 

t  INITIALIZE  DABUF  ARRAY  FOR  SWEEP 
C 

ICALL  *  401 

CALL  LPASSETIBF  (DABUF# ISTAT#DAMSKB# IOBUF) 

IF  (.NOT.  ISTAT)  GO  TO  1950 
C 

C  SET  UP  FOR  LPA11  SUBSYSTEM  NUMBER 
C 

ICALL  *  402 

CALL  LPASLAHSKS  (D AMSKB# IUNIT) 

C 

C  RELEASE  THE  BUFFER  (BUFFER  NUMBERS  ARE  USED  RATHER  THAN  NAMES) 

C 

ICALL  •  403 

CALL  LPASRLS8UF  (DABUF# I  ST  AT#0) 

IF  (.NOT.  ISTAT)  60  TO  1950 
C 

C  CALCULATE  NUMBER  OF  DATA  POINTS 
NPOINT  *  NFRAME  *  NCHAN 
C  SPECIFY  ONLY  ONE  BUFFER  TO  BE  FILLED 
NBUF  *  1 

C  IN  REV  C  OF  THIS  ROUTINE#  ISMODE  IS  SPECIFIED  IN  THE  CALLING  PARAMETERS 
C  IN  D/A  MODE#  A  DELAY  OF  A  LEAST  150  MICROSECONDS  MUST  BE  SPECIFIED  BEFORI 
C  THE  FIRST  CONVERSION  TAKES  PLACE.  SINCE  THE  LPASXRATE  CALL  RETURNS  THE  \ 
C  OF  IRATE  (SPECIFYING  A  CLOCK  RATE)#  LDELAY  (THE  DELAY  IN  IRATE 
C  UNITS  BEFORE  FIRST  SAMPLE)  IS  SET.  (PARA  2.4.1  OF  LPA11  USER’S  GUIDE) 

C  IRATE  *  1  FOR  1  MHZ#  IRATE  *  2  FOR  100  KHZ;  IRATE  =  3  FOR  1CKHZ;  ETC- 
LDELAY  *  1 

IF  (IRATE. EQ.1)  LDELAY  *  150 
IF  (IRATE. EQ. 2)  LDELAY  *  15 
IF  (IRATE. EG. 3)  LDELAY  *  2 
C  SPECIFY  SAMPLE  ON  EVERY  CLOCK  OVERFLOW 
IDWELL  *  1 

C  PROCEED  WITH  SWEEP  START  CALL 

C  SWEEP  CALL  SPECIFIES  FLA6  BE  SET  AT  COMPLETION 
ICALL  *  404 

CALL  LPASDASWP  ( DABU F# NPOINT#NBUF# I SMOD E# I  DWELL#! VAL ( I F L AG ) # 

1  LDELAY# I CHAN# NCHAN# ISTAT) 

IF  (.NOT.  ISTAT)  GO  TO  1950 
C 
C 

C  RETURN  TO  CALLING  PROGRAM  ...  ISTAT  IS  STATUS  OF  D/A  SWEEP  CALL 
GO  TO  1950 
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C  *****  MODE  =  5  ***** 

C  START  DIGITAL  INPUT  SWEEP  FOR  "CHANNEL  A" 

c 

500  CONTINUE 
C 

C  CLEAR  DIGITAL  INPUT  EVENT  FLAG 
ICALL  *  500 

ISTAT  *  SYSSCLREF  < XV AL < I  FLAG) ) 

IF  (.NOT.  ISTAT)  GO  TO  1950 
C 

C  CHECK  THAT  NC HAN  IS  EQUAL  TO  ONE 
ISTAT  =  0 
ICALL  =  501 

IF  (NCHAN.NE. 1 )  GO  TO  1950 
ISTAT  =  1 
C 

C  INITIALIZE  DIBUFA  ARRAY  FOR  SWEEP 
C 

ICALL  =  502 

CALL  LPASSETIBF  (DIBUFA*ISTAT*DIMSKA*IOBUF) 

IF  (.NOT.  ISTAT)  GO  TO  1950 
C 

C  SET  UP  FOR  LPA11  SUBSYSTEM  NUMBER 
C 

C  SPECIFY  START  WORD  CHANNEL  OF  CHANNEL  ZERO  (I/O  GUIDE  PAGE  5*22) 

IDSC  =  0 

C  SPECIFY  EVENT  MARK  WORD  CHANNEL  OF  CHANNEL  0 
IEMC  *  0 

C  SPECIFY  DIGITAL  START  WORD  MASK  OF  ALL  BITS 

10  SW  *  -1  w* 

C  SPCEIFY  EVENT  MARK  WORD  MASK  OF  ALL  BITS 
IEMW  =  -1 
ICALL  =  503 

CALL  LPASLAMSKS  (DIM$KA*IUNIT**IDSC*IEMC*ID$W*IEMW*) 

C 

C  RELEASE  THE  BUFFER  (SUFFER  NUMBERS  ARE  USED  RATHER  THAN  NAMES) 

C 

ICALL  =  504 

CALL  LPASRLSBUF  ( D IBUF A, I S T AT * 0 ) 

IF  (.NOT.  ISTAT)  GO  TO  1950 
C 

C  START  DIGITAL  INPUT  SWEEP  BY  SPECIFYING  ONLY  ONE  BUFFER 
C 

C  FOR  THIS  NODE*  THE  NUMBER  OF  POINTS  MUST  EQUAL  NUMBER  OF  FRAMES 
NPOINT  =  NFRAME 

C  SPECIFY  ONLY  ONE  BUFFER  TO  BE  FILLED 
NBUF  =  1 

C  IN  REV  C  OF  THIS  ROUTINE*  ISMODE  IS  SPECIFIED  IN  THE  CALLING  PARAMETER  .• 

C  PROCEED  WITH  SWEEP  START  CALL  ^  • 

C  SWEEP  CALL  SPECIFIES  FLAG  BE  SET  AT  COMPLETION 
ICALL  =  505 

CALL  LPASOISWP  ( DI BU F A* NPO INT* NBUF *  I  SHOD E* *XV AL ( I FL AG) * * 

1  ICHAN*NCHAN, ISTAT) 

IF  (.NOT.  ISTAT)  GO  TO  1950 
C 
C 

C  RETURN  TO  CALLING  PROGRAM  ...  ISTAT  IS  STATUS  OF  OIGITAL  INPUT  S-V'P  C 
GO  TO  1950 
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C  *****  MODE  *  6  ***** 

C  START  DIGITAL  OUTPUT  SWEEP  FOR  "CHANNEL  A" 

C 

600  CONTINUE 
C 

C  CLEAR  0X6ITAL  OUTPUT  EVENT  FLAG 
XCALL  *  600 

XSTAT  «  SYSSCLREF  (XVAL (IFLAG) ) 

XF  (.NOT.  XSTAT)  GO  TO  1950 

C 

C  CHECK  THAT  NCHAN  IS  EQUAL  TO  ONE 
ISTAT  *  0 
XCALL  *  601 

IF  (NCHAN. NE.1)  GO  TO  1950 
ISTAT  *  1 
C 

C  INITIALIZE  008UFA  ARRAY  FOR  SWEEP 
C 

ICALL  *  602 

CALL  LPASSETI8F  (D08UFA#ISTAT#D0MSKA#I0BUF) 

IF  (.NOT.  ISTAT)  GO  TO  1950 
C 

C  SET  UP  FOR  LPA1 1  SUBSYSTEM  NUMBER 
C 

C  SPECIFY  START  WORD  CHANNEL  OF  CHANNEL  ZERO  (I/O  GUIDE  PAGE  5-22) 

IDSC  *  0 

C  SPECIFY  EVENT  NARK  WORD  CHANNEL  OF  CHANNEL  0 
XENC  *  0 

C  SPECIFY  DIGITAL  START  WORO  MASK  OF  ALL  SITS 
IDSW  *  -1 

C  SPCEIFY  EVENT  MARK  WORO  MASK  OF  ALL  BITS 
IEMW  *  -1 
ICALL  »  603 

CALL  LPASLAMSKS  (DOMSKA# IUNIT## IDSC# I EMC#IDSW# IEMW# ) 

C 

C  RELEASE  THE  BUFFER  (BUFFER  NUMBERS  ARE  USED  RATHER  THAN  NAMES) 

C 

ICALL  *  606 

CALL  LPASRLSBUF  (DOBUF A# I STAT#0) 

IF  (.NOT.  ISTAT)  GO  TO  1950 
C 

C  FOR  THIS  MOOE#  THE  NUMBER  OF  POINTS  MUST  EQUAL  NUMBER  OF  FRAMES 
NPOINT  *  NFRAME 

C  SPECIFY  ONLY  ONE  BUFFER  TO  BE  FILLED 
NBUF  *  1 

C  IN  REV  C  OF  THIS  ROUTINE#  ISMODE  IS  SPECIFIED  IN  THE  CALLING  PARAMETERS 
C 

C  IN  DO  MODE#  A  DELAY  OF  A  LEAST  150  MICROSECONDS  MUST  BE  SPECIFIED  BEFORE 
C  THE  FIRST  CONVERSION  TAKES  PLACE.  SINCE  THE  LPASXRATE  CALL  RETURNS  THE 
C  OF  IRATE  (SPECIFYING  A  CLOCK  RATE)#  L DEL AY  (THE  DELAY  IN  IRATE 
C  UNITS  BEFORE  FIRST  SAMPLE)  IS  SET.  (PARA  2.6.1  OF  LPA11  USER*S  GUIDE) 

C  IRATE  *  1  FOR  1  MHZ#  IRATE  *  2  FOR  100  KHZ#’  IRATE  =  3  FOR  10KHZ;  ETC. 
LDELAY  »  1 

IF  (IRATE. EQ.1)  LDELAY  *  150 
XF  (IRATE. EQ. 2)  LDELAY  *  15 
IF  (IRATE. EQ. 3)  LDELAY  *  2 
C  SPECIFY  SAMPLE  ON  EVERY  CLOCK  OVERFLOW 
XOWELL  *  1 

C  PROCEED  WITH  SWEEP  START  CALL 


C  SWEEP  CALL  SPECIFIES  FLAG  BE  SET  AT  COMPLETION 
ICALL  3  605 

CALL  LPASOOSUP  (DOBUFAsNPO INT/NBUF*  ISMODEs  IDWELLsXVALC  IFLA6-*:.->. 

1  LDELAY,ICHAN,NCHAN, ISTAT) 

IF  (.NOT.  ISTAT)  GO  TO  1950 
C 

C  RETURN  TO  CALLING  PROGRAM  ...  ISTAT  IS  STATUS  OF  DI6ITAL  OUTPUT  SWEEP  < 
GO  TO  1950 


C  *****  NODE  *  7  ***** 

C  START  OIGXTAL  INPUT  SWEEP  FOR  "CHANNEL  8" 

C 

700  CONTINUE 
C 

C  CLEAR  DIGITAL  INPUT  EVENT  FLAG 
ICALL  *  700 

ISTAT  -  SYSSCLREF  (XVAL(IFLAG)) 

IF  (.NOT.  ISTAT)  GO  TO  1950 
C 

C  CHECK  THAT  NCHAN  IS  EOUAL  TO  ONE 
ISTAT  *  0 
ICALL  *  701 

IF  (NCHAN. NE.1)  GO  TO  1950 
ISTAT  *  1 
C 

C  INITIALIZE  DIBUFB  ARRAY  FOR  SWEEP 
C 

ICALL  *  702 

CALL  LPASSETIBF  (OI8UFB#ISTAT#DINSKB#IOBUF> 

IF  (.NOT.  ISTAT)  GO  TO  1950 
C 

C  SET  UP  FOR  LPA11  SUBSYSTEM  NUMBER 
C 

C  SPECIFY  START  WORD  CHANNEL  OF  CHANNEL  ZERO  (I/O  GUIDE  PAGE  5-22) 

IDSC  *  0 

C  SPECIFY  EVENT  MARK  WORD  CHANNEL  OF  CHANNEL  0 
IEMC  »  0 

C  SPECIFY  DIGITAL  START  WORD  MASK  OF  ALL  PITS 
XOSW  «  -1 

C  SPCEIFY  EVENT  MARK  WORO  MASK  OF  ALL  BITS 
1EMW  «  -1 
ICALL  «  703 

CALL  LPASLAMSKS  (DIMSKB#IUNIT##IDSC#IEMC#IDSW#IEHW#) 

C 

C  RELEASE  THE  BUFFER  (BUFFER  NUMBERS  ARE  USED  RATHER  THAN  NAMES) 

C 

ICALL  *  704 

CALL  LPASRLSBUF  (DIBUFB# ISTAT rO) 

IF  (.NOT.  ISTAT)  GO  TO  1950 
C 

C  START  DIGITAL  INPUT  SWEEP  BY  SPECIFYING  ONLY  ONE  BUFFER 
C 

C  FOR  THIS  MODE#  THE  NUMBER  OF  POINTS  MUST  EQUAL  NUMBER  OF  FRAMES 
NPOZNT  »  NFRAME 

C  SPECIFY  ONLY  ONE  BUFFER  TO  BE  FILLED 
NBUF  *  1 

C  IN  REV  C  OF  THIS  ROUTINE#  ISMODE  IS  SPECIFIED  IN  THE  CALLING  PARAMETERS 
C  PROCEED  WITH  SWEEP  START  CALL 

C  SWEEP  CALL  SPECIFIES  FLA6  BE  SET  AT  COMPLETION 
ICALL  *  70S 

CALL  LPASDISWP  (DI8UFB#NPOINT#N8UF#ISMODE##XVAL (I FLAG)## 

1  ICH AN# NCHAN# ISTAT) 

IF  (.NOT.  ISTAT)  GO  TO  1950 
C 
C 

C  RETURN  TO  CALLING  PROGRAM  ...  ISTAT  IS  STATUS  OF  DIGITAL  INPUT  SWEEP  CALI 
GO  TO  1950 


C  *****  MODE  *  8  ***** 

C  START  DIGITAL  OUTPUT  SWEEP  FOR  "CHANNEL  B"  v*-£ 

c 

800  CONTINUE 

c 

C  CLEAR  DX6ITAL  OUTPUT  EVENT  FLAG  ->V 

I  CALL  *  800 

ISTAT  *  SYSSCLREF  (X VAL ( I  FLAG) ) 

IF  (.NOT.  ISTAT)  GO  TO  1950 

C  *  .  .J 

C  CHECK  THAT  NCHAN  IS  EQUAL  TO  ONE  K?\“ 

ISTAT  *  0  '•  ••: 

ICALL  *  801  ■r-yl;- 

IF  (NCHAN. NE.1)  GO  TO  1950 
ISTAT  *  1 

c 

C  INITIALIZE  008UFB  ARRAY  FOR  SWEEP  y-rr 

C 

ICALL  *  802 

CALL  LPASSETIBF  (D0BUFB*ISTAT*D0M$K8*I0BUF> 

IF  (.NOT.  ISTAT)  GO  TO  1950 

c 

C  SET  UP  FOR  LPA11  SUBSYSTEM  NUMBER  J 

c 

C  SPECIFY  START  WORD  CHANNEL  OF  CHANNEL  ZERO  (I/O  GUIDE  PAGE  5-22) 

idsc  *  o  ■■■:.:■ 

C  SPECIFY  EVENT  MARK  WORD  CHANNEL  OF  CHANNEL  0 

IEMC  *  0  r  ;*V'v 

C  SPECIFY  0I6ITAL  START  WORD  MASK  OF  ALL  BITS  W  _ j 

IOSW  a  -1 

C  SPCEIFV  EVENT  MARK  WORD  MASK  OF  ALL  BITS 

ie  mw  *  -i 

ICALL  »  803  >-• 

CALL  LPASLAMSKS  (OOMSKB* 1  UNIT*  *  I  DSC,  I  EMC  *  IDSW*  I EMW#  )  .  V-'! 

C 

C  RELEASE  THE  BUFFER  (BUFFER  NUMBERS  ARE  USED  RATHER  THAN  NAMES) 

c  >y 

ICALL  =  804  ;-y- 

CALL  LPASRLSBUF  (D0BUFB*ISTAT*0)  "v\: 

IF  (.NOT.  ISTAT)  GO  TO  1950 
C 

C  FOR  THIS  MODE*  THE  NUMBER  OF  POINTS  MUST  EQUAL  NUMBER  OF  FRAMES  -r— 

NPOINT  *  NFRAME 

C  SPECIFY  ONLY  ONE  BUFFER  TO  BE  FILLED 
NBUF  *  1 

C  IN  REV  C  OF  THIS  ROUTINE  *  ISMODE  IS  SPECIFIED  IN  THE  CALLING  PARAMETER 

c  . 

C  IN  DO  MODE*  A  DELAY  OF  A  LEAST  150  MICROSECONDS  MUST  BE  SPECIFIED  BEFO-*~c- 
C  THE  FIRST  CONVERSION  TAKES  PLACE.  SINCE  THE  LP ASXRATE  CALL  RETURNS  TH-S-S 
C  OF  IRATE  (SPECIFYING  A  CLOCK  RATE)*  LDELAY  (THE  DELAY  IN  IRATE  \Xv 

C  UNITS  BEFORE  FIRST  SAMPLE)  IS  SET.  (PARA  2.4.1  OF  LPA11  USER'S  GUIDE) r'v': 
C  IRATE  *  1  FOR  1  MHZ*  IRATE  *  2  FOR  100  KHZ;  IRATE  *  3  FOR  10KHZ;  ETC.  's-v 
LDELAY  «  1 

IF  (IRATE. EQ.1)  LDELAY  =  150  _ _ 

IF  (IRATE . EQ. 2)  LDELAY  =  15 

IF  (IRATE. EQ.  3)  LDELAY  =  2  /v 

C  SPECIFY  SAMPLE  ON  EVERY  CLOCK  OVERFLOW 

I  DWELL  *  1  I  s- 


C  PROCEED  WITH  SWEEP  START  CALL 

C  SWEEP  CALL  SPECIFIES  FLAG  BE  SET  AT  COMPLETION 
ICALL  *  EOS 

CALL  LPASDOSWP  (D0BUFB#NP0INTsN3UFr ISMODEs IDWELLs XVALC IFL AG)s 
1  LDELAY*XCHAN#NCHAN* 1ST  AT) 

IF  (.NOT.  XSTAT)  GO  TO  19S0 
C 

C  RETURN  TO  CALLING  PROGRAM  ...  XSTAT  IS  STATUS  OF  DIGITAL  OUTPUT  SWEEP  CAL 
GO  TO  1950 
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C  *****  NODE  «  13  ***** 

C  SET  STATUS  OF  A/O  SWEEP 
C 

1300  CONTINUE 
C 

I CALL  »  1301 

ZSTAT  *  LPASIWTBUF(ADBUF) 

LSTAT  »  XAND(ADX0SB(3)*'FF00*X)/2S6 
60  TO  1950 


y 


C  *****  NODE  »  14  ***** 

C  GET  STATUS  OF  0/A  SWEEP 
C 

1400  CONTINUE 
C 

ICALL  *  1401 

ISTAT  *  LPASIWTBUF(DABUF) 

LSTAT  *  IAN0(DA10S8(3)s>FF00'X)/256 
60  TO  1950 


C  *****  NOOE  *  15  ***** 

C  GET  STATUS  OF  DIGITAL  INPUT  SWEEP  FOR  "CHANNEL  A' 
C 

1500  CONTINUE 


ICALL  *  1501 

ISTAT  =  LPASIWTBUF(DIBUFA) 

LSTAT  -  IAND(0II0SA(3)s>FF00'X)/256 
GO  TO  1950 


C  *****  NODE  *  16  ***** 

C  6ET  STATUS  OF  DIGITAL  OUTPUT  SWEEP  FOR  "CHANNEL  A' 
C 

1600  CONTINUE 
C 

ICALL  =  1601 

ISTAT  -  LPASIWTBUFCDOBUFA) 

LSTAT  =  IAND(D0I0SA<3)x*FF00,X)/256 
GO  TO  1950 


C  *****  NODE  =  17  ***** 

C  GET  STATUS  OF  DIGITAL  INPUT  SWEEP  FOR  "CHANNEL  B* 
C 

1700  CONTINUE 
C 

ICALL  =  1701 

ISTAT  *  LPASIWTBUFCDIBUFB) 

LSTAT  *  XAND(DII0S3(3)s,FF00*X)/256 
GO  TO  1950 


C  *****  NOOE  *  18  ***** 

C  GET  STATUS  OF  DIGITAL  OUTPUT  SWEEP  FOR  "CHANNEL  B' 
C 

1800  CONTINUE 
C 


... 
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ICALL  *  1001 

ZSTAT  »  LPASIMTBUFCDOBUFS) 

LSTAT  •  IAN0(DOX0SB(3)^*FF00*X>/2S6 
CO  TO  1950 


C  *****  ERROR  SERVICE  ROUTINE  ***** 

C 

1950  CONTINUE 

C  TRANSFER  STATUS  INFORMATION  ON  CALLING  PARAMETER 
C 

RETURN 

C 

ENO 


SUBROUTINE  IV LH ( C*  CO*  Q*  RE  F*  DBX*  D8Y*DBZ*WB*  J  ET*D  ELT  AT*  NAXWX 
MAXWY#MAXWZ#PXCK#T) 

ATTEMPTS  TO  NOLO  BODY  AXES  IN  ALIGNMENT  WITH  LVLN  AXES 

INTEGER  C(12}*CO(12>* SNAP* I*  J*  PICK 

REAL  Q<4)*REF(4»*YAW*P ITCH* ROLL# DBX* OB Y*DBZ 

REAL  W8(3)#JET(4*12)*DELTAT*HAXVX*MAXWY*MAXWZ 

REAL  AN6(3>*T(3*3>*PI*SWT*VT 

REAL  FQ(4>*FW8(3)*FT<3#3>*QT(3#3)*REFT(3#3> 

REAL  C0NST*QQ(4) 

PI*2.0*ACOS(0.0) 

WAS  RHC  JUST  MOVED  TO  NEUTRAL  ?  IF  SO*  TAKE  SNAPSHOT. 

RE  F(4)  -  QUATERNION  AT  TIME  OF  SNAPSHOT. 

SNAP  -  FLAG  TO  TAKE  SNAPSHOT  OF  QUATERNION. 

SNAP*0 

00  150  1*7*12 

IF  (CCO(I)-C(I))  .GT.  0)  SNAP*1 
CONTINUE 

IF  (SNAP  .EQ.  1>  THEN 
RE  F (1 ) *Q<1 ) 

REF(2)*Q(2) 

REF(3)*Q(3) 

REF<4)*Q(4) 

ENOIF 

COMPUTE  FUTURE  QUATERNION  (NEXT  ITERATION) 

FW8  -  FUTURE  BODY  RATE 
FQ  -  FUTURE  QUATERNION 

ANGC1 J*0.0 
ANG( 2) *0. 0 
ANG<3)*0.0 

FQ(1 )*Q(1 ) 

FQ(2)*Q(2) 

FQ (3 )=Q  (3) 

FQ(4)*Q(4) 

FN9< 1 >*HB(1 ) 

FUB(2)*W3(2) 

FUB(3)*UB(3) 

CALL  ROTATE (ANG#DELT AT *FW8*FQ* FT) 

COMPUTE  TRANSFORMATION  FROM  REF  FRAME  TO  C-W  FRAME 
CALL  TRN$FM(REFT*REF) 

COMPUTE  TRANSFORMATION  FROM  FQ  FRAME  TO  REF  FRAME 

DO  81  1*1*3 
00  82  J *1  *  3 

QT(I*J)*REFT(1*I)*FT(1*J)>REFT<2*I)*FT(2*J)* 

REFT(3*I)*FT(3*J) 


CONTINUE 


CONTINUE 


CONFUTE  QUATERNIONS  (FRON  FQ  TO  REF) 

•0<4>«1.04RT(1^1)4RTC2#2)«QT(S/S> 

IF  (00(4)  .LT.  .IE-30)  00(4)*. IE-30 

00(4 )*$ORT( 00(4) )/ 2.0 

00(1 )*(OT(3#2)-QT(2*3))/(4.0*QQ(4)) 

00(2)*(0T(1 #3)-0T(3#1 ))/ (4. 0*00(4) ) 
QQ(3)*(QT(2,1)-GT(1,2>)/<4.0*QQ(4>) 

NORMALIZE  QUATERNIONS 

CONST*SQRT(OQ(1)*QQ(1)+QQ(2)*QQ(2)+ 

•  00(3) *00(3)900 (4) *0Q(4)> 

00(1 )*Q0(1) /CONST 

00 (2) *00(2) /CONST 
00(3) *00(3) /CONST 
00 (4) *00 (4) /CONST 

CONFUTE  ANGLE  OF  ROTATION  BETWEEN  FRAMES 

WT*2.0*ACOS(QO(4) ) 

SWT* SIN (WT/ 2.0) 

CONFUTE  ANGULAR  DIFFERENCE  (OF  FQ  W.R.T.  REF) 

IF  CUT  .LT.  .0000001)  THEN 
ROLL-O.O 
PITCH-0. 0 
YAW-0.0 
ELSE 

R0LL*00(1 )*WT/SWT 
FITCN*00( 2) *WT/SWT 
YAW*00( 3) *WT/ SWT 
ENOIF 

DETERMINE  THRUST  PROFILE  BY  CHECKING  ROLL*  PITCH 
AND  YAW  ANGLES/RATES  AGAINST  ATTITUDE  HOLD  CRITERIA. 

CALL  CHECKCR0LLs08XsWB(1>sC(7)#C(8)sJET(PICKs7), 

*  JET(PICK#8)#MAXWXsDELTAT) 

CALL  CHECK(PlTCHsD8Y*WB(2)sC(9)rC(10)#JET(PICKr9)s 

•  JET(PICKs10)#MAXWYsDELTAT) 

CALL  CHECK(YAW*D8Z#WB(3)«C(11)rC(12)rJET(PICKs11)s 

*  J£T(PICKx12)#MAXWZxDELTAT) 


SUBROUTINE  MOD£<SAsSBsSCsLA*LB#LC) 

TAKES  ONE  COLUMN  OF  DAP  PANEL  MANUAL  MODE  AND 
FIfiURES  OUT  WHAT  LI6HTS  TO  TURN  ON/OFF  (LAsLBsLC > 
USING  SWITCH  COMMANDS  <SA,S8*SC> 

INTEGER  SAsSBsSCsLAsLB*LC 

IF  CSA  .EQ.  1)  THEN 
LA«1 
LB*0 
LOO 

ENDIF 

IF  (SB  .EQ.  1)  THEN 
LA*0 
LB*1 
LOO 

ENDIF 

IF  (SC  .EQ.  1)  THEN 
LA*0 
LB»0 
LOI 

ENDIF 
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SUBROUTINE  PREDPATH(0ME6AsTIME*0LDXsX) 

C 

C  THIS  SUBROUTINES  PREDICTS  POSITION  (X)  RELATIVE  TO 
C  TARSET  GIVEN  PRESENT  POSITION  AND  SPEED  COLDX)  AND 
C  FUTURE  TIME  (TINE) 

C 

REAL  0ME6AsX(3)#0LDX(6)sTIM£»CW#SW 
C 
C 

CW*COS(OME6A*TIME) 

SW*$IN<0ME6A«TIME) 

C 

X(1)»OLDX(1 >-2.0*OLDX<5> /OMEGA 

XC1>»X<1>~3.O*<0LDX<4)+2.O*0NEGA*OLDX<2>>*TIME 

X<1)*X(1>+2.0*<3.0*0LDX(2)+2.0*0LDX<4>/0MEGA>*SW 

X(1)*X(1)+2.0*0LDX<5)*CW/0MEGA 

C 

X<2>«4. 0*0LDXC2)*2.0*0LDX<4) /OMEGA 
X<2)*X<2)~CW*<3.0*CLDX<2>*2.0*0LDXC4)/0MEGA> 
X(2)*X(2)+OLDX(5)*SW/OM£GA 
C 

X(3)*0LDX(6)*SW/0ME6A+CLDX(3)*CW 

C 

C  SCALE  DOWN  FOR  HUD  DISPLAY 

C  CONVERT  TO  LH  SYSTEM 

C 

X<1)-X<1)/100. 

X(2)*X(2)/100. 

X(3)«-X<3)/100. 

c 

END 


SUBROUTINE  PS 300 C ALTO, INCLIN) 

THIS  SUBROUTINE  IS  THE  GRAPHICS  PROGRAM  FOR  THE 
SHUTTLE  SIMULATOR.  IT  GENERATES  A  TARGET*  ROTATING 
EARTH*  HORIZON  AND  STAR  FIELD  FOR  BACKGROUND. 
SUBROUTINE  LOOK  SENDS  NEW  DATA  TO  THIS  PROGRAM  IN 
THE  PS300  TO  UPDATE  TARGET  RANGE  AND  ATTITUDE  AND 
EARTH/STAR  ROTATIONS. 

INCLUDE  'CALFAN03 PROCONST. FOR/ NOLI ST* 

L06I CAL*1  POSLIN( 73) 

REAL  ALT*INCLIN*AT(3)*FM(3)*UP(3)*DSTAR 
REAL  HORR*HORT*HORD*LONG*ANG*ALTD 
REAL*4  V( 3) 

INTEGER  IsNVEC 
DIMENSION  V£CS(4*73) 

DATA  POSLIN/. FALSE. *72*. TRUE./ 

ATTACH  GRAPHICS  DEVICE  AND  INITIALIZE  GRAPHICS 

CALL  PATTCH(*LOGD£VNAM=PIAO:/PHYDEVTYP*PARALLEL**ERR) 
CALL  PINIT(ERR) 


V( 3)  -  VECTOR  ARRAY  FOR  PS300 

HORR  -  RADIUS  OF  EARTH  HORIZON  AS  SEEN  FROM  TARGET  (DU) 
HORD  -  DISTANCE  OF  HORIZON  FROM  EARTH  CENTER  (DU) 

HORT  -  DISTANCE  OF  HORIZON  FROM  TARGET  (DU) 

DSTAR  -  DISTANCE  OF  STAR  CLIPPING  PLANE  FROM  TARGET  (OU) 


COMPUTE  EARTH  HORIZON  RADIUS  (HORR)* 

DISTANCE  FROM  EARTH  CENTER  (HORD)* 

AND  DISTANCE  FROM  TARGET  TO  HORIZON  (HORT) 

ALT*ABS(ALTD/6378.135) 

H0RD=1 .0/ (1 • 0+ ALT) 

H0RR*SQRT(1 .0-H0RD*H0R0) 

HORT=HORR/HORD 

UNITS  VARY  FROM  METERS  TO  DUS  DEPENDING  ON  WHAT  IS 
BEING  DISPLAYED.  THIS  UNIT  JUGGLING  IS  DONE  TO 
MINIMIZE  SCALING  ERRORS  INHERENT  IN  THE  PS300. 

INITIALIZE  VECTORS  FOR  PS300  VIEWING 
V  -  DUMMY  VECTOR 
AT*  FM* UP  -  VIEWING  VECTORS 


V(1 ) *0. 0 

V(2) a0. 0 

V ( 3) =0. 0 

AT(1)=0.0 

AT(2)»0.0 

AT(3)*0.0 

FM(1 )  =0 .0 

FM(2)*0.0 

FM(3)*-20.0 

UP(1)=0.0 

UP(2 ) =1 0. 0 


UP(3)«0.0 


COMPUTE  ATTITUDE  DISPLAY  DATA  FOR  HUD 

CALL  PBE6S(*XYZVC*#ERR) 

UNITS  ARE  IN  METERS 

CALL  PSEDCLC* CLIP* #. FALSE. #*"*#ERR) 

CALL  PVIEUP<*"*#-1.0#1.0#-1.0#1.0#1.0#1.0#*"*#ERR) 
CALL  PFOV <* FOV* ,35. 0*1.0# 3000. #•"*# ERR) 

CALL  PLOOKAI*LOOK,#AT#FM#UP#*"*#ERR) 

CALL  PSCAL£<*SCALE*#V#*"*#ERR) 

CALL  PSECOLC*"*#180.0#1.Q#*XARROW*#ERR) 

CALL  P$EC0L(*"*#18Q.0#1.0#*YARR0W*#ERR) 

CALL  PSECOLC  *"' #1 80.0*1.0* ' Z ARROW #  ERR) 

CALL  PENDS(ERR) 

COMPUTE  PITCH  AND  FUTURE  TRACK  DATA  FOR  HUD 

CALL  P8EGS(*XYPTH*#ERR) 

CALL  PSEDCL(*CLIP*#.FALSE.#*"*#ERR) 

CALL  PVIEUPC*"* #.3#1.0#.3# 1.0*1. 0,1. 0,'"', ERR) 

CALL  PWINDO<*yNDW*#-11.#11.#-11.#11.#0.#100.#*"*#ERR) 
CALL  PLOOKA(*LOOK*#AT#FH#UP#*"*#ERR) 

CALL  PROTV (*ROTY*#180.#*"'#ERR) 

CALL  PSECOL<*"*#300.0#1.0#*"*#ERR) 

CALL  PTRANSt*TRNl*#V#* DIAMOND*# ERR) 

CALL  PTRANS<*TRN2*#V#*0IAM0N0*# ERR) 

CALL  PTRANSC'TRN3*#V#' DIAMOND*# ERR) 

CALL  PTRANS<*TRN4*#V#* DIAMOND*# ERR) 

CALL  PTRANS<*TRN5*#V#' DIAMOND*# ERR) 

CALL  PSECCL(*"*#180.0#1 .0# *X VAX  IS  * # ERR) 

CALL  PTRANS(*SSTR*#V#"**#ERR) 

CALL  PR0TZ(*R0TZ*#0.#*"*#ERR) 

CALL  PR0TX<*R0TX*#90.#*STICKSTS,#ERR) 

CALL  PENDS(ERR) 

COMPUTE  PIPPER  DISPLAY  DATA 

CALL  PBEGS(*6UNSITE*#ERR) 

CALL  PSEOCLC  CLIP*#.  FALSE.#*"*#  ERR) 

CALL  PVIEWPC'"*#-1 .0#1.0#-1.0#1.0#1.0#1.0#'"*#ERR) 
CALL  PWINDOI*  HNDH* #-1 .#1 . #-1 . #1 .#0.# 1 00. # * "* # ERR) 

CALL  PLOOKA(*LOOK*#AT#FM#UP#*"*#ERR) 

CALL  P$ECOL(*"*#120.0#1.0#*PIPPER*#£RR) 

CALL  PENDS(ERR) 

COMPUTE  DISPLAY  DATA  FOR  RANGE#  RANGE  RATE# 

FUEL  ANO  TIME. 

CALL  PB£GS('INFO*#ERR> 

CALL  PSEDCL<*CLIP*#. FALSE. #*"*#ERR) 

CALL  PVIE«P<»"*#-1.0#1.0#-1.0#1.0#1.0#1.0#'"*#ERR) 
CALL  PyiNDO(*MNDH*#0.#80.#0.#80.#0.#100.#*"*#ERR) 

CALL  PLOOKA ( ‘LOOK*  #AT#FM#UP#*"'#ERR) 

CALL  PSECHH('"'#*"*#ERR) 

CALL  PCMSCA(*"*#1.#1.#*"*»ERR) 

CALL  PCHS<*"*#0. #79. #1. #1 .#0.#' RANGE  (FT)’#ERR) 

CALL  PCHS<*"'#0.#77.#1.#1.#0.#*RANGE  RATE'#ERR> 

CALL  PCHS<*"*#0.#75.#1.#1.#0.#'  FUEL  USED'#ERR) 

CALL  PCHS<*"'#0.#73.#1.#1.#0.#,r:ME  (SEC)*#ERR) 


CALL  PCHS (‘RANGE * /I 2.x79.,1.,1 .,0.,*  000000* ,ERR> 
CALL  PC  HS { *  RRA7E'#1 2./77./1 .#1 .#0.#*  000000 ' »  ERR) 
CALL  PCHS  <*RFUEL',12../-  75.  ,1.  ,1  .»0w'  000000*#  ERR) 
CALL  PCHS(‘RTIME  ' ,  1 2  .  ,  73.// 1 .  *  1  ., 0. ,* 000000 ** E RR> 
CALL  PENDS(ERR) 

COMPUTE  DISPLAY  DATA  FOR  SPINNING  SATELLITE 

CALL  P8EGS(*TARGT'*ERR) 

UNITS  ARE  IN  METERS 

CALL  PS  ED  CL  ('CLIP'/-. FALSE. ERR) 

CALL  PVIEyP<*"**-1.0*1.0/-1.0*1.0,1.0/-1.0,  ,",.rERR) 
CALL  PFOVt*  FOV*/-  35. 0*1 .0/3000. *•"*  *ERR) 

CALL  PLOCKAC 'LOOK*  *AT*FM/UP* '"'^ERR) 

CALL  PINST!*"*** SAT£L*/ERR) 

CALL  PENDS(ERR) 

CREATE  A  TORS  SATELLITE 

CALL  P8EGS(*SATEL**ERR) 

V(1 )*-1 .8 
V<2)=0.0 
V(3)*0.  0 

CALL  PTRANS(,**,*V**"'*ERR) 

CALL  PROTX(,R0TX,//0.0*,”,/-ERR) 

V(1)=.2 

V(2)*.2 

V(3)=.2 

CALL  PSCAL£(*,***V*"*,*ERR) 

CALL  PSECOL(,,*,/300.0/'1.0»*",^ERR> 

DO  150  1=10*360*10 
LONG* I 

CALL  PROTX('*'*/-L0NG,*ftTDRS,/-ERR) 

CONTINUE 
CALL  PEND S ( ERR ) 


CREATE  A  SPINNING/INCLINED  GLOBE  OF  THE  EARTH* 

ADD  A  STAR  FIELD  AND  SET  THE  ENTIRE  PICTURE 
COUNTER-ROTATING  W.R.T.  TARGET  ORBIT. 

ADD  A  STATIONARY  HORIZON 

CALL  PBEGS<  *  GLOB  E  • /- E  RR  ) 

UNITS  ARE  IN  DU 

CALL  PS  ED  CLC  CLIP*  /.TRUE./-*"*  /-ERR) 

CALL  PI/I  Ey?<*"**-1.0*1.0*-1.0*1.C* 1.0*  1.0*  *  "'/-ERR) 
CALL  PF0V(,",/-35.0».1*ALT/- 
HORT+.O 1* ,H ’* ERR) 

CALL  PLOOKA  (*  LOOK*  *  AT/-  FM*UP**"'*ERR) 

V(1 >=0.0 
V<2)=(-1.-ALT) 

V ( 3 ) =0. 0 

CALL  PTRANS(,,,**V*',,,*ERR) 

CALL  PINSTt*"**' HORIZON* *ERR) 

CALL  PROTI(,TR0T,*0.0*’",*ERR) 

CALL  PSECCLl *"’ *  240. *1  .**"'*ERR> 

CALL  PROTX(,”**90.-INCLIN/,”**ERR) 

CALL  PROTV(*EROT**0.0/-,,,’*ERR> 

CALL  PINST(*"**'WORLD**ERR) 

CALL  PSF:CCL(,,"/-240.*0.0/-,"’*ERR) 
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CALL  PINSTC"", 'SPHERE', ERR) 

CALL  PINST("",'LATLINE*,ERR> 

CALL  PENOS(ERR) 

C 

C  CREATE  A  HORIZON  FROH  A  CIRCLE 

C 

CALL  PBE6SC ' HORIZON*  ,E  RR) 

C  UNITS  ARE  IN  DU 

V(1>*0.0 
V(2)*HORD 
VC3)*0.0 

CALL  PTRANS<"",V,"",ERR> 

CALL  PR0TX<"",90.,"",ERR) 

V<1 )*HORR 
V<2)*V<1) 

V(3)»V(1> 

CALL  PS  C  AL  EC "'/V, 'CIRCLE', ERR) 

CALL  PENOS(ERR) 

C 

C  CREATE  A  STAR  FIELD 

C 

CALL  P8EGSO  STARS'/ERR) 

C  UNITS  ARE  IN  DU 

CALL  PSEDCL<'CLIP',.TRUE.,**",ERR) 

CALL  PVIEWPC"", -1.0, 1.0, -1.0, 1.0,1. 0,1.0,"",  EAR) 
DSTAR*H0RT+«9*SQRT((2.*ALT+1.)**2-1.) 

CALL  PFOVC'"' ,35.0, .1*DSTAR,0S TAR, ERR) 

CALL  PLOOKA ( ' LOOK ' ,AT,FH,UP, '“'/ERR) 

V<1)»0.0 
VC2)  —  1.-ALT 
V(S)*0.0 

CALL  PTRANS<"",V,"",ERR) 

CALL  PROTZ<'TROT',0.0,"",ERR) 

CALL  PSECOLC"", 180., 0. ,'***, ERR) 

CALL  PROTV ('"',90.,' STARS . TWINKLE ', ERR) 

CALL  PROTXC  ""  ,90. ,' STARS. TWINKLE' , ERR) 
VC1)*1.+2.*ALT 
V(2)*V(1) 

V(3)*V(1) 

CALL  PSCALE<'TWINKLE',V,' STAR ',ERR) 

CALL  PENDS(ERR) 

C 

C  BUILD  A  SPHERE  FROH  A  CIRCLE 

C 

CALL  PBEGSC'SPHERE',ERR) 

DO  200  1*10,1 80,10 
LONG*I 

CALL  PROTT<"", LONG, 'CIRCLE',  ERR) 

200  CONTINUE 

CALL  PENDSCERR) 

C 

C 

C  BUILD  A  HEHI-SPHERE  FROH  A  SEHI-CIRCLE 

C 

CALL  PBEGS('HEHI',ERR) 

DO  222  1*15,180,15 
LONG* I 

CALL  PROTV('"', LONG, ' SENI' , ERR) 

222  CONTINUE 

CALL  PENDSCERR) 


* -  ^  w  ( 


EgRSRsmnpmpP*1 


rr 
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C 

c 

C  COMPUTE  LINES  OF  LATITUDE  USING  CIRCLES 

C 

CALL  PB£6S<*LATLINE*,ERR) 

CALL  PR  OTXC'*",  90.0,  'CIRCLE*, ERR) 

CALL  PROTX(*w,,9C.O, *LAT*,ERR) 

CALL  PROTX<***i/-90.0/,LATt#ERR) 

CALL  PENDS(ERR) 

C 

C 

CALL  PBEGS('LAT',ERR) 

00  20  1=10,80,10 

ANG=I*. 0174532925 
V(1)  =  0.0 
V<2)=0.0 

V<3>  = SI N<ANG)-SIN(ANG-.1 74532925) 

CALL  PTRANSC-'^V^'-^ERR) 

V(1 )=COS(ANG> 

V<2)=V<1) 

V<3)«0.0 

CALL  PSCALEe***^, 'CIRCLE*, ERR) 

20  CONTINUE 

CALL  PENDS(ERR) 

C 

C 

C  VECTOR  LIST  FOR  CIRCLE 

C 

DO  10  1=1,73 

AN G= 5. 0*(I”1)*. 0174532925 
V£CS(1,I)=C0S(ANG) 

VECS(2,I)=SIN<ANG) 

VECS(3, I) =0.0 
VECS (4, I) =1 .0 
10  CONTINUE 

C 

NVEC=73 

CALL  PVCBEGC  CIRCLE' ,NVEC,.TRUE.,. FALSE., 3, PVITEM,ERR) 
CALL  PVCLIS(NVEC,VECS,POSLIN,ERR) 

CALL  PVCEND (ERR) 

C 

C 

C  VECTOR  LIST  FOR  SEMI-CIRCLE 

C 

DO  12  1  =  1,13 

ANG* (-90. 0*1 5.0* C 1-1) >*.0174 532925 
VECS(1,I)=SIN(ANG) 

VECS(2,I>=C0S(ANG> 

VEC  S ( 3, I ) =0. C 
VECS  <4, I) =1 .0 
12  CONTINUE 

C 

NVEC*1 3 

CALL  PVC8EG('SEMI*,NVEC, .TRUE., .FALSE., 3, PVITEM, ERR) 
CALL  PVCLIS(NVEC,VECS,POSLlN,CRR) 

CALL  PVCEND (ERR) 

C 

C  COMMANDS  FOR  HUD  ROTATION 

C 

C  SEND  LABEL  TO  DIAL  AND  DECLARE  ROTATE  FUNCTION 
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CALL  PSNSTC  *  HUD  *,1 **DLABELl *,ERR> 
CALL  PFN( *HUD*  * *YROTATE**ERR) 

CONNECT  INPUTS  TO  ACCUMULATOR 

CALL  PFN(*ACC1***  ACCUMULATE  •  *  E  RR) 

CALL  PCONNC 'DIALS* /t/1 * *ACC1 *, ERR) 
CALL  PSNREA<18C.,2/*ACC1*,ERR> 

CALL  PSNREA(1.s3**ACC1*#ERR) 

CALL  P$NREA<-15w4**ACC1**ERR> 

CALL  PSNREAC360.*5** ACC1 *,ERfi> 

CALL  PSNREA (0.r6r*ACC1 **ERR) 


CONNECT  ACCUMULATOR  OUTPUT  TO  ROTATE  FUNCTION 
AND  THEN  TO  PROGRAM. 

CALL  PCONN<*ACC1*,1#1,*HUD*,ERR> 

CALL  PCONN<*HUD*#1#1#*XYPTH.ROTY*#ERR) 


CALL  NEEDED  VECTOR  LISTS 


CALL  VECTOR 
CALL  VECTOR 
CALL  VECTOR 
CALL  VECTOR 
CALL  VECTOR 
CALL  VECTOR 
CALL  VECTOR 
CALL  VECTOR 
CALL  VECTOR 
CALL  VECTOR 


< 'DIAMOND*  #7) 
(*RTDRS*#5> 

< a  STICKSTS**8) 
( *  XYAXI Sa  * 6) 

C a  X ARROW*  *6) 

( *  Y  ARROW*  x  6) 

( *  Z ARROW  *  *  6) 
<*PIPPER*#6> 

( *  WORLD*  #  5 ) 

<  *  ST  AR  *  *  4) 


DISPLAY  ALL 

CALL  PDISPC*XYPTH*#ERR) 
CALL  PDISP(*GUNSITE**ERR) 
CALL  PDISP<*TARGT*#ERR> 
CALL  PDISP( 'GLOBE* »ERR) 
CALL  PDI$P(*STARS*#ERR) 
CALL  PDISP<*lNFO*,ERR> 
CALL  POISP{*XYZVC**ERR> 

DETACH  GRAPHICS  DEVICE 

CALL  PDTACH(ERR) 

END 


.■aa-.va-,-. 
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SUBROUTINE  PULSE (COUNT 1 /COUNT2/C1 /C 2/ DEL, J ET1 / J ET2) 

DETERMINES  HOW  MANY  PULSES  ARE  NEEDED  FOR  THRUST  COMMAND. 
(COUNT1 /COUNT2) .  RESETS  CONTROL  SWITCHES  (C1/C2)  TO 
EXECUTE  PROPER  NUMBER  OF  PULSES  REGARDLESS  OF  THC/RHC 
POSITION. 

INTEGER  COUNT1/COUNT2/C1/C2 
REAL  JET1 /JET2/DEL 

COUNT  DOWN  ONE  PULSE 

COUNT1» COUNT 1-1 
COUNT2*COUNT2-1 

IF  JETl  OR  JET2  IS  ZERO/  EXIT  SUBROUTINE 

IF  CA8S(J£T1)  .LE.  .00000001)  GOTO  150 
IF  ( ABS ( J  ET  2)  .LE.  .00000001)  GOTO  150 

SET  COUNTERS  IF  NOT  PULSING  FROM  PREVIOUS  COMMAND. 

DEL  -  DESIRED  VELOCITT  INCREMENT 

JETl #2  -  VELOCITY  INCREMENT  GAINED  BY  ONE  PULSE 

IF  ( C0UNT1  .LT.  1)  C0UNTlsA8S(INT(C1*DEL/JET1)> 

IF  (C0UNT2  .LT.  1)  C0UNT2*ABSC INT (C2*DEL/JET2) ) 

SET  CONTROL  SWITCHES  BASED  ON  COUNTERS 

IF  ( C0UNT1  ,6T.  0)  C1*1 
IF  ( C0UNT2  .GT.  0)  C2=1 
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SUBROUTINE  QDOT (0,yX#WY/y2/ DELTAT) 

C 

C  FIGURES  QUATERNION  RATE  (30)  AND  LINEARLY  INTEGRATES 

C  FOR  TIME  STEP  OELTAT. 

C 

REAL  Q (4) sQD( 4) sWX#yYsWZs DELTAT /CONST 
INTEGER  J 
C 

QD (1 >*<Q(2>*WZ'Q<3>*UY+Q(4>*WX)*.S 
Q0(2)*(-Q<1 )*yZ>Q(3)*WX*Q(4)*WY>*.5 
Q0(3)«(a<i)*yY-Q(2)*yx+a<4)*wz)*.5 
0D(4)*(-a(i)*yx-a(2>*yY-Q(3)*yz)*.5 

c 

00  100  J*1,4 

Q(J)*Q(J)+D£LTAT*QD(J) 

100  CONTINUE 
C 

C  NORMALIZE  QUATERNIONS 


C0NST*S3RT(Q(1)*Q(1)+0(2)*Q(2)*0(3)*0(3)*Q(4)*C(4)) 

0(1)=Q(1)/C0NST 

Q(2)*Q(2)/C0NST 

Q(3) *0(3) /CONST 

3(4) =0(4) /CONST 


E-8 1 


SUBROUTINE  ROT AT E ( AN6# DELT AT #W B# Q#  T ) 

C 

C  LINEARLY  INTEGRATES  TO  FIND  ROTATION  IN  BODY  FRAME#  THEN 

C  TRANSFORMS  TO  REFERENCE  FRAME. 

C 

REAL  ANG(3)sUB(3)#D£LTATsG(4)*T(3#3) 

C 

C  COMPUTE  BODY  RATES  (MB) 

C  CAN6  IS  ANGULAR  ACCELERATION) 

C 

WBC1)«UB(1)4>DELTAT*ANGC1) 

W9(2)*M8(2>*DELTAT*ANG(2> 

WB(3 )*W8( 3) +DELTAT*AN5f3) 

C 

C  FIND  QUATERNION  RATE  AND  INTEGRATE 

C 

CALL  QDOT(8sW8(1)sU9(2)sWS(3)sDELTAT) 

C 

C  COMPUTE  ROTATION  MATRIX 

C 

CALL  TRNSFP (T#Q) 

C 

END 


SUBROUTINE  SWITCHCS/L) 


CONTROLS  LIGHT  PANEL  FOR  DAP  BUTTONS 

INTEGER  S (24)#LC20*  FILLER 

S  -  SWITCH  POSITION  (1 *TRIPPED*0*UMTRIPPED) 

L  -  LIGHT  < 1 *ON*0*0  F F ) 

FILLER  -  EMPTY  VARIABLE  TO  BE  USED  AS  FILLER  WHEN  CALLING  MODE 


CHECK  SELECTION  MODE 


IF 

(SCI) 

.EQ. 

1) 

LC1>«1 

IF 

(SCI) 

.EQ. 

1) 

LC2 J*0 

IF 

CSC2) 

.EQ. 

1) 

LC1 )*0 

IF 

(  SC 2 ) 

.EQ. 

1) 

L  C  2  >  =  1 

CHECK 

AUTOPILOT  MODE 

IF 

CSC3) 

.EQ. 

1) 

LC3) =1 

IF 

CSC3) 

.EQ. 

1) 

L  C4  >  *0 

IF 

CSC4) 

.EQ. 

t) 

LC3)*0 

IF 

CSC4) 

.EQ. 

1) 

L  C4 ) *1 

CHECK 

THRUSTER 

1  MODE 

IF 

CSC5) 

.EQ. 

1) 

LC51«1 

IF 

CSC5) 

.EQ. 

1) 

L  C6)  =  0 

IF 

CSC6) 

.EQ. 

1) 

L  C5 ) *0 

IF 

CSC6) 

.EQ. 

1) 

L  C6)*1 

CHECK  X,Y ,1  TRANSLATION  MODES 

CHECK  LOW  Z  MODE: 

IF  CSC17)  .EQ.  1)  THEN 
L(17)=1 
LC18>»0 
LC21>*0 
LC24>=0 
ENDIF 

CALL  MOD£CSC16>,SC19),SC22>,LC16>,LC19),LC22>) 
CALL  MODEC0*SC20)*SC23)*FILLER*L(20)*LC23>) 
CALL  M0DECSC18)*$C21)rSC24)*LC18>#LC21)»LC24)> 

IF  (<L<18)*L<2mL(20)  .3T.  0)  L(17)-0 

CHANGE  THRUSTER  MODE  I F  Hl/LO  Z  SELECTED 

IF  C  CL C 1 7)*LC1 8) )  .GT.  O)  THEN 
L  C  5  )  « 1 
L  <  6) *0 
ENDIF 

CHECK  ROTATION  MOOES 


CALL  H0DE(S(7)*S(10)*SC13)rL(7)*L<10)*L(13)) 
CALL  M00ECSC8)»S(11)»SC14)»L<8)^L(11)/L(14)) 
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SUBROUTINE  THRUST (J ET SEL/ A, ANG/ G A S/C/PICK/ TABLE) 

TAKES  JETSEL  MATRIX  AND  SUMS  ROWS  AS  COMMANDED  BY  C. 

A  *  ACCEL  X/ Y/  Z  (FPS2/BODY  FRAME) 

ANC  -  ANGULAR  ACCEL  X/Y/Z  (RAD/S2/BODY  FRAME) 

GAS  *  FUEL  TAKEN  FROM  THREE  TANKS 

( 1-FORWARD*  2-RI6HT  AFT/  3-LEFT  AFT) 

REAL  JETSEL (44/9)/A( 3)/ANG(3)/ GAS (3) 

INTEGER  I/J/C(12)/PICK/SEL£CT(44)/R0W/TABLEC4/12/9> 

DETERMINE  UHAT  THRUSTERS  HAVE  BEEN  COMMANDED  TO  FIRE 

DO  145  1*1/44 
SELECT ( I ) *0 
CONTINUE 

DO  175  1*1/12 

IF  (C(I)  .GT.  0)  THEN 
DO  185  .1*1/9 

ROW*TABLSO»ICK/I/J) 

IF  (ROW  .GT.  0)  SELECT (ROW) *1 
CONTINUE 
ENDIF 
CONTINUE 

SUM  COM* ANDEO  ROWS  OF  JETSEL 

DO  95  1*1/3 
A(I)*0.0 
ANG(I)*0.0 
GAS(I)*0.0 
CONTINUE 

DO  200  1*1/44 

IF  (SELECT! I)  .GT.  0)  THEN 
A(1)*A(1)*JET$£L(I/1) 

A(2)*A(2)+JETSEL(I/2) 

A(3)*A(3)+JETSEL(I/3) 

AN6(1)*ANG(1)+JETSEL(I/4) 

ANG(2)=ANG(2)+JETSEL(I/5) 

ANG (3 )* ANG (3) ♦JETS EL ( 1/6) 

GAS (1)*6AS(1) ♦JETSEL! 1/7) 

GAS (2)*GAS (2) ♦JETSEL! 1/8) 

GAS (3)*6 AS (3) ♦JETSEL (1/9) 

ENDIF 

CONTINUE 


I  .  IV.'l'.  ,*  '.*  ,«.>  ■_' 
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SUBROUTINE  TRNSFM<T,0> 

C 

C  CONFUTES  TRANSFORMATION  MATRIX  (T)  FROM  QUATERNIONS  (Q) 

C 

REAL  T(3,3>*Q<4> 

C 

T<1,1>*Q(1)*Q(1>-Q<2>*Q<2)-Q<3>*a(3}*a<4)*a(4> 

T(2^1)*2.0«(Q(1)*a(2)«-Q(3)*C(4>) 

T<3,1>*2.0*<Q(1>*a<3>-Q<2>*Q(4>> 

T(1#2>*2.0*(4(1>*Q(2)-Q(3)*Q<4>> 

T(2^2)*-0<1)*Q(1)+fl(2)*Q(2)“Q(3)*a<3)*0C4)*a<4> 

T<3,2>*2.0«r(Q<2>*Q(3>+Q(1>*a(4>> 

T<1,3>«2.0*<0<1>*a<3)*Q<2>*Q<4>> 

TC2,3)«2.0*<Q(2)*a(3>-an  >*Q<4>> 

T(3/3)**Q(1 )*QC1)-Q<2)*a(2)*Q<3)*3<3)+a(4)*QC4> 

C 

END 


SUBROUTINE  UNITIZE(V) 
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UNITIZES  V  VECTOR 
REAL  V<3)*«AGV 


Vv  ■/ 

■  •*'.  *‘i 

*  •  •  . , 


v'‘*Av 


If  <ABS<V<1>)  .LT.  .IE-10)  V<1)*.1E-1Q 

IF  (ABS(V(2))  .LT.  .IE-10)  VC2)*. IE-10 

If  (ABS(V(3))  .LT.  .IE-10)  V(3)». IE-10 

MASV*S8RT(V(1)*V(1)+V(2)*V(2)+V(3)*V(3)) 

V(1)*V(1)/NA6V 

V(2) *V(2) /NA6V 

V(3)«V(3)/NA€V 


r  ■*  5  -  -J| 
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SUBROUTINE  VECTOR  (NAME/LENGTH) 

C 

C  THIS  SUBROUTINE  READS  A  VECTOR  LIST  FRO*  VAX 

C  FILE  AND  PUTS  IT  IN  USABLE  FORM  FOR  THE  PS500 

C 

INCLUDE  *  CALFANOJPROCONST. FOR/ NOLIST  * 

INTEGER**  IPOS/  LENGTH/  CLASS 
REAL**  POINTS  U/2000) 

LOGI C AL*1  POSLIN  (2000)/  PL/  VL 
CHARACTER  NAME*8/  FILENAME*26 

FILENAME*’ tALFANO. DATA  3* //NAME (:LENGTH>//’ .DAT’ 

OPEN  <  UNIT=1 /  NAME=FILENAME/TYPE=’OLD'/READONLY) 

READ  (  1/  910)  VL/IPOS 

910  FORMAT  (  A1/I1C) 

IF  C(VL.EO.’C’)  .OR.  (VL.EO.’C*))  THEN 
CL ASS*0 

ELSE  IF  ( (VL*  EQ. *  D* )  .OR.  (VL  .EO.’D’))  THEN 
CLASS*1 

ELSE  IF  ( (VL. EQ. *  I  * )  .OR.  (VL  .EQ.’I’))  THEN 
CLASS*2 

ELSE  IF  ( (VL. EG. ' S  '  )  .OR.  (VL  .EQ.’S'))  THEN 
CLASSES 
ENDIF 

DO  3*10  I=1/IP0S 

READ  (  1/  911)  PL/(P0INTS(K/I)/K=1/3) 

911  FORMAT  (  A1 /  3F12.3) 

POINTS  (*/I)*1 

POSL IN ( I ) *. FALSE. 

IF  ((PL.EQ.'L’)  .OR. (  PL.EO.’L*))  POSL I N ( I ) = . TRUE . 

3*10  CONTINUE 

CALL  PVCBEG  ( NAME ( :LENGTH ) / I POS/ . F ALSE . / . F AL SE . / 3/ CLA S $z ERR ) 
CALL  PVCLIS  (IPOS/POINTS/POSLIN/ERR) 

CALL  PVCEND  (ERR) 

CLOSE  (UNIT=1 ) 


SUBROUTINE  WINDOW<T,TW,Xl*X2,X3#TARG) 

this  subroutine  computes  the  transformation  matrix 

FROM  REF  TO  WINDOW  (TW)  USING  THE  MATRIX  FROM  BOD 
TO  REF  <T>.  WINDOW  IS  ASSUMED  TO  HAVE  -X,-Z  BODY 
COMPONENTS.  POSITION  OF  TARGET  FROM  WINDOW  (TARG) 
IS  COMPUTED  KNOWING  POSITION  OF  SHUTTLE  FROM  TARGET 
(Xls  X2#X3) . 

WINDOW  AXIS  DEFINED  AS  FOLLOWS: 

TARGC1)  -  INTO  SCREEN 
TARGC2)  -  LEFT 
T ARG (3)  -  UP 

REAL  T(3s3)/TW<3/3)sXlsX2sX3#TARG(3),C 
C-SQRTCO. 5) 

COMPUTE  TRANSFORMATION  MATRIX 

TW<1,1)*-C*<TC1,1)+T<1,3>> 

TW<1,2>=-C*<T<2,1>+TC2,3)> 

TWC1,3>*-C*(T<3,1»+T(3/3)> 

TW<2,1)*T<1#2> 

TWC2,2>»T<2,2> 

TU (2#  3) *T (3#  2) 

TW(3*1>*C*(T(1*1)-T<1*3)> 

TW<3r2)»C*CT<2,1>-T(2,3>> 

TW<3,3)=C*CT<3,1)-T<3#3)> 

COMPUTE  TARGET  VECTOR 

TARGC1>«-m*TU(1,1>*X2*TW<1#2>*X3*TW(1,3>> 

TARG<2»*-CX1*TW<2^1)+X2*TW<2-r2)*X3*TW(2r3)) 

TARG(3)*-<X1*TW(3.1I>X2*TW<3^2>+X3*TWC3.3)) 


rp 5T 


